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!•   INTRODUCTION 


Replenishment  at  sea,  has  become  a  common  and  necessary 
practice  in  almost  all  the  navies  of  the  world. 

Underway  replenishment  as  it  is  understood  today, 
implies  the  operation  of  at  least  two  ships  steaming  at 
close  proximity.  Experience  and  studies  over  the  years  have 
shown  that  when  doing  so  the  ships  must  withstand 
hydrodynamrc  Forces  and  Moments  that  tend  to  alter  their 
dynamics  creating  situations  that  involve  the  risk  of 
collision.  Knowing  this  fact  it  is  of  pure  logic  to  think  of 
some  automatic  device  that  could  prevent  and  compensate  this 
hydrodynamic  phenomena.  Unfortunately,  the  data  available 
today  do  not  assure  a  complete  understanding  of  it.  This 
limitation  does  not  mean  that  such  automatic  system  must  be 
seen  as  impossible;  the  mathematical  model  of  a  ship 
developed  by  Abkowitz  [ 1 ],  gives  the  chance  to  include  these 
forces  and  moments  as  enviromentai  forcing  functions. 

Engineer's  studies  have  ranged  froa  the  simple  case 
where  the  dynamic  of  one  ship  without  external  forcing 
functions  is  involved  to  more  complex  ones  where  the 
dynamics  of  two  ships  are  coupled  by  the  interactive 
effects. 

The  most  recent  one  [  8  ]r  which  was  used  as  starting 
point  for  this  work,  treated  two  ships  steaming  at  close 
proximity  as  one  system  of  multivariable  inputs  and 
multivariable  outputs,  and  it  developed  a  reliable  automatic 
control  system  that  allowed  both  ships  to  keep  their 
relative  stations  during  the  replenishment  maneuver. 

This  work,  investigates  the  posibility  of  improving  the 
above  mentioned  control  system  in  order  to  increase  its 
capabilities  to  the  general  and  more  desirable  situation 
where  the  automatic  control  system  starts  operating  at  J ;he 
Approach  Phase. 


II •   EQUATIONS  OF  MOTION 


A.  MATHEMATICAL  MODEL  OF  A  SURFACE  SHIP 

The  derivation  of  a  mathematical  model  representing  the 
steering  and  maneuvering  cf  a  surface  ship  in  open  water  is 
given  by  Abkowitz  [  1  ].  In  its  general  form,  the  model 
accounts  for  non-linear,  as  well  as  linear  effects. 

Bodies  moving  in  a  fluid  medium  are  free  to  move  in  six 
degrees  of  freedom.  In  order  to  define  the  equations  of 
motion,  a  right  hand  rectangular  coordinate  system  is 
established,  the  origin  of  which  is  chosen  to  be  in  the  body 
itself,  as  shown  in  Figure  II-1.  The  origin  and  the  axis  are 
fixed  with  respect  to  the  body  but  movable  with  respect  to 
another  systea  of  coordinates  axis  fixed  in  space;  it  is 
assumed  that  at  time  t=0  (initial  time  of  the  problem)  both 
systems  coincide. 

Straight  foiward  Newtonian  Mechanics  Lav:s  of  motion  for  a 
rigid  body  can  be  written  as  two  equations  -one  a  force 
equation  and  the  second  s  moment  equation.  The  equations 
are: 

d  (momentum) 
(external  forces)   Fe= — 

dt 

d (angular  momentum) 
(external  moments)  Ke= — 

dt 

(II- 1) 

The  equations  describing  the  ship's  six  degrees  of 
freedom  have  been  found  [  1  ]  to  be: 

X=m[  O-RV+QW-X.  (R2+Q2) +Y.  (PQ-R)  +Zf   (PR+Q)  ] 

fc>  G  \r 


I=m[ V-PW+RO+X  (R+PW)-y   (P2+R2)+Z  (PQ-P)  l 
&  G  O 

Z=m[ W-QU+PV+X  (PR-Q)-sY  (P+QR)  -Z„  (Q2  +  P2)  ] 

&  G-  G 


L=PI,  +  (I,  -I  )  QR+m[  Y  (W-QU+PV)-Z^  (V-PW  +  BU)  ] 
M=QIy  +  (I,  -I,  )  PE  +  m[  ZG  (U-RV+QW)  -X&  (J-QU+PV)  ] 
N=HII  +  (Iy  -I,  )  PQ  +  m[  XQ  (V-PW+RU)  -Y&  (U--RV  +  QW)  ] 


(H-2) 


(where  the  notation  U=5u/5t  is  used) 

Satisfying  the  following  equations: 

— >  — >  —>   — > 
Fe=iX+jY+kZ 

Me=iL+jH+kN 

and  where  the  symbols  used  stand  for: 

m  Mass  of  the  ship, 

X,Y,Z       Components  of  force  in  the  x,  y,  z  directions. 

L,M,N       Components  of  moment  about  the  x,  yf  z  axis. 

U,Vrw       Components  of  velocity  in  the  x,  y,  z,  directions. 

X  .Y„#Z     Distances   from   the   center   of   gravity   to  the 

G  '  G  *    O  v 

origin  in  the  x,  y,  z  directions. 

P,Q,R       Components   of   the  angular  velocity  about  the  x, 
y,  z  axis. 

I  ,1  ,1,    Moments  of  inertia  about  the  x,  v,  z  axis. 

X    Y    2  *      ■*  ' 

Equations  II--2  describe  the  reaction  of  the  rigid  body  to 
applied  forces  as  a  function  of  the  geometric  and  physical 
characteristics  of  the  body  itself.  They  do  not  include  any 
of  the  applied  external  forces  such  as  propeller  thrust, 
rudder  forces,  moments  and  forces  due  to  the  fins  (if  any)  , 
reaction  forces  of  the  fluid  (hydrodynacnic  forces) ,  and 
waves  and  wind  forces. 
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1 .    Equations  of  motion  for  a  sh ip_  moving  in  the 
horizontal  £lane 

Normally,  when  dealing  with  steering  and 
maneuvering  of  surface  ships  in  open  water,  the  primary 
motions  are  considered  to  take  place  in  the  horizontal 
plane,  and  vertical  motions  are  neglected.  As  this  is  also 
the  case  of  interest,  where  only  horizontal  motions  are  of 
concern,  the  equation  in  Z,  the  vertical  force  equation  can 
be  dropped.  Under  the  assumption  of  calm  waters,  roll,  pitch 
and  heave  are  all  negligibles,  i.e., 

P=P=Q=Q=W=W=0 

Hence  equations  II-2  reduce  to 

X=m[  U-RV-XG3-YG  R] 

Y=m[ V+UB+X    B-Y    B] 

L  &  G        J 

«  • 

V  —  ID  T         •   —  r    V         <  "   >.  ~>  TT  *    _-  V         f  TT  _  W  '7  \      1 

im  —  t\±z  f  En    a.     [  »  *ii  U/      I      i U     ii  V  j    j 

&  G 

(II-3) 

and  assuming  the  coordinate  axis  origin  placed  at  the  center 
of  gravity,  X  =Y =0,  equations  II-3  become 

X=m[U-RY],  surge 

Y  =  a[V+UK],    sway 

N=BI2  ,    yaw 

(II-4) 

The  left  hand  sides  of  equations  II-4  represent  the 
forces  and  moments  along  and  about  the  coordinate  axes,  and 
the  right  hand  sides  show  the  corresponding  dynamic 
reaction. 
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2-    Linearization  through  Taylor J_s  series  expansion 

The  forces  and  moments  on  the  left  hand  side  of 
equations  II-1  through  II-4  can  be  expressed  as  properties 
of  the  body/  properties  of  the  fluid  and  motion. 

Since  steering  and  maneuvering  are  of  interest, 
forces  and  moments  are  also  considered  as  function  of  rudder 
(control  surface)  deflections  and  the  change  in  r.p.m  of  the 
propeller  shaft,  furthermore,  for  a  surface  ship  moving  on 
the  horizontal  plane  no  forces  or  moaents  are  due  to 
orientation  changes.  Hence: 

(X/Y/N)^f(u,r,v,u,r,v,d,o/An,etc) 

(II-5) 

In  general  it  is  possible  to  linearize  a  function 
f (x)  by  the  use  of  Taylor's  series  expansion,  thus 


f(x)-f(x0)^+l 


where  Ax=x-x  .  For  small  values  of   x  the  second  order  terras 
o 

can  be  neglected  and  thus   considering   only   the   following 
expression  for  f (x) : 


f  (x)=f  <x0)+Ax^f 


(II-6) 


The  same  principle  can  be  applied  for  small 
perturbations  in  equations  II-5,  which  is  a  function  of  many 
variables.  Since  the  Taylor  expansion  is  written  for  a 
particular  point,  this  point  is  chosen  to  be  an  equilibrium 
position.  An  equilibrium  position  is  that  of  straight  ah< 
motion,  at  constant  speed  with  rudder  amidship.  The 
hydrodynamic  forces  and  moments  have  been  found  to  be: 

X=X,,  u+X  v  +  X  r+X.  u+X.  v  +  X«  r+X.£  +X.An 

u     v    r    u    v    r    <S    N 

where  Au=u-un  and  An=n-n  and  the  subscript  0  is  referred  to 
the  values  of   the   variables   at   the   initial   equilibrium 
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condition  and  where  all  the  partial  derivatives  are 
evaluated.  For  Y  and  N  similar  expressions  hold.  Equating 
the  linearized  expression  for  X,  Y  and  N  with  equations  II-U 
results  in  the  linearized  equations  of  motion  for  steering 
and  maneuvering: 

X  Au+X  v+X  r+X.  u  +  X.  v  +  X.  r  +  X«S  +X  An=mu 

u  vruvrdn 

Y  Au  +  Y    v  +  Y   r+Y.  u+Y;  v  +  Y.  r  +  Y,£  +Y  An=m(v  +  ru) 

N   Au  +  N    v  +  N    r  +  N'  u  +  N-  v  +  N-  r  +  N,  S+N  An=I,  f 

(II-7) 

The  derivatives  Xy  ,  X.  ,  X  ,  X;  ,  Xs  ,  Yu  ,  Y«  ,  Nu  ,  N-  , 
vanish  for  any  symmetrical  port  and  starboard  shape  of  ship 
(symmetry  about  the  xz-plane) .  This  has  the  effect  of 
decoupling  surge  from  sway  and  yaw. 

Furthermore,  considering  negligible  the  effect  of 
An  in  Y  and  N  equations,  equations  II-7  become: 

(X-  -m)  u  +  X  Au  =-X  An 

(Y.  -m)  v+Yy  V+(Y  -mu)r+Y.  r=-Yj? 


(N- -l)r+N  r  +  N-  v+N  v    =~N,S 


Nondimens ionalizat ion 


(II-8) 


For  computer  simulation  purposes,  equations  II-8 
are  used  with  the  nondimensional  coefficients  of  a  Mariner 
ship,  whose  characteristics  are  those  of  Table  II-2.  The 
nondimensional  nomenclature  is  shown  in  Table  II-1,  and  the 
nondimensional  coefficients  and  conversion  factors  are  shown 
in  Table  II.-3.  [2>3].  Llzo  it  is  of  interest  to  point  o 
that  the  digital  computer  time  frame  is  in 
nondimensionalized  forn. 

In  order  to  simplify  the  notation,  no  special 
symbols  are  used  for  the  nondimensional  quantities,  being 
understood  that  only  these  quantities  are  of  concern. 
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TABLE  II- 1 


NONDIMENSIONAL  NOMENCLATURE 


Symbol  Definition 


X\  Derivative   of   longitudinal  force  component  with 

u 

respect  to  longitudinal  acceleration  component  u. 

X'  Derivative   of   longitudinal  force  component  with 

u 

respect  to  longitudinal  velocity  component  u. 

y*  Derivative    of    lateral   force  component   with 

v 

respect  to  transverse  velocity  component  v. 

Y*  Derivative    of    lateral   force   component   with 

v 

respect  to  transverse  acceleration  component  v. 

Y'  Derivative    of    lateral   force   component   with 

r 

respect  to  yaw  angular  velocity  component  r. 

Y\  Derivative    of    lateral   force   component   with 

f 

respect  to  yaw  angular  acceleration  component  r. 

Y5^  Derivative    of    lateral   force   component   with 

respect  to  rudder  angle  component  S  . 

N'  Derivative    of    yawing   moment   component   with 

v 

respect  to  transverse  velocity  component  v. 

N*„  Derivative   of    yawing   moment  component   with 

v  • 

respect  to  transverse  acceleration  component  v. 

K'  Derivative    of    yawing   moment   component   with 

r 

respect  to  yaw  angular  velocity  component  r. 

N*  Derivative   of    yawing   moment   component   with 

r 

respect  to  yaw  angular  acceleration  component   r. 

NTV         Derivative    of    yawing   momest   component   with 
respect  to  rudder  angle  component  <P  . 
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X5  Derivative   of  longitudinal  force  component  with 

n 

respect  to  change  in  propeller  r.p.m. 

Y'  Derivative    of    lateral   force   component   with 

n 

respect  to  change  in  propeller  r.p.m. 

N>  Derivative    of    yawing   moment   component   with 

n 

respect  to  change  in  propeller  r.p.m. 

r'  Yawing  angular  velocity  component. 

« 

r*  Yawing  angular  acceleration  component. 

U*  Velocity   of   origin   of   body   axes   relative  to 

fluid. 

v*  Transverse   velocity   component  of  origin  of  ship 

axes  relative  to  fluid. 

v*  Transverse    acceleration    component    of    ship 

relative  to  fluid. 

X5  Hydrodynamic     longitudinal     force    (positive 

direction  forward) . 

Y'  Hydrodynamic  lateral  force  (positive  direction  to 

starboard)  . 

m1  Mass  of  the  ship. 

u*  Velocity  of   origin   of   ship's   axes   along   the 

x-axis. 

u5  Acceleration  of  origin  of  ship's  axes   along   the 

x-axis. 

I"5         Moment  of  inertia  of  the  ship  with  respect  to  the 
z 

z-axis. 

t1  Time  frame. 
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TABLE  II-2 

MARINER  CHARACTERISTICS  AND  MAXIMUM  VALUES 
OF  SELECTED  PARAMETERS 

Length,  ft  527.8 

Beam,  ft  76.0 

Draft,  ft  29.75 

Displacement,  tons  16800.0 

Block  coefficient,  Cb  0.6 

Yaw  angle  (RAD)  0„26 

Yaw  velocity  (RAD/SEC)  0.0349 

Suge  velocity  (FT/SEC)  5.064 

Propeller  speed  (RPM)  30.0 

Rudder  deflection  (RAD)  0.35 
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TABLE  II-3 

NONDIMENSIONAL  HYDRODYNAMIC  COEFFICIENTS 
NUMERICAL  VALUES  AND  CONVERSION  FACTORS 


Nondimensional 
Coefficients 


Nondimensionalizing 
Factors 


Non dimensional 
Values*E+05 


(Y'.-mV  ) 
r        G 

(X'.-m') 

u 

X' 


Y> 


Y' 


S 


(Y'.-iaM 

v 

(Y* -m«) 
r 

N> 
v 

n\ 


l£ 


x' 


Y' 

n 

N' 
n 

(N»  ~n?x*  ) 
r         G 

{N»  -I'  ) 

r      z 


0.5*pL* 
0.5*pL3 
0.5*pL2u 
0.5*pL2u 
0. 5*pL2u2 
0.5*pL3 
0.5*pL3u 
0. 5*pL3u 
0. 5*pL* 
0.5*pL3u2 
0.5*pL3u 
0.5*PL3u 
0. 5*pL4u 
0.5*pi.3u 
0.5*PL*u 
0.5*pLs 
L/u 


-27 

-850 
-120 
-1243 

27  0 
-1500 
-510 
-351 
-19.7 
-126 

4.62 
-0.52 

0.26 

0.0 
-227 
-68 
20.86 


Note:    p=    Sea   water    density     (1.9905    slug/ft3) 
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4.    Computer  simulation 

If  the  motion  of  the  ship  is  to  r>e  considered  under 
external  perturbations  and  with  acting  controls,  no  furtner 
simplifications  in  equations  II-8  are  possible. 

Thrust,  rudder  and  fin  forces  and  moments  are 
considered  control  elements,  all  other  forces  and  moments 
are  not  normally  controllable  inputs,  but  they  must  be 
included  in  cases  where  the  ship  has  to  be  controlled  in 
their  presence.  To  this  category  belong  the  interactive 
forces  and  moments  generated  in  the  case  of  ships  in  close 
underway  replenishment  stations. 

Taking  the  Laplace  Transform  of  equations  II-8  and 
considering  the  ship  steaming  in  equilibrium  conditions 
(i.e.,  steady  forward  speed  uQ=1) 

v(s)[s(Y;-m)+Yv  ]+r(s)[sY.  +  Yrm]=-Yy  (?(s) 

v  (s)  [  sH.  +N¥  ]+r  (s)  [  s  (N;  -Iz  )  +N  ]=-Na  J(s) 

u(s)[s(X:-m)+Xu  ]  =-Xn  n(s) 

V 

Since  r(s)=sl(s),  equations  II-9  become: 

_v_(s)[s2  (m-Y*)-yy  s]+Y(s)  [-s2I-  +s(m-Yr  )  ]=Xj  <5(s) 
_v  (s)  [  -S2NJ  -sNv  ]+Y(s)  [  s2  (lz  -N;  )  -sNr  ]    =N*  <?(s) 

s 

_u_(s)  [  S2  (m-X;  )  -sXu  J  =Xn  n  (s) 


(II-9) 


(11-10) 


letting: 


all=m-Y& 
bi»=-Yv 
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cn=0 

b2i=m-Yr 

c2i=0 

ai2=-N. 

b  i 2  =-  Mv 

ci2=0 

a22=Ii  -N; 

b22=-Nr 

C22=0 

a33=m-X. 
u 

b33=-Xu 
C33=0 


Equations    11-10    can    be    written   as: 
_v(s)  [ai  is2  +  bi  is+cn  ]+^(s)  [a2iS2-!-b2  is+c2i  3=7^^  (s) 

s 

JV  (S)  [al2s2  +  bl2s+C12  3+^(3)  [a2  2S2+b2  2s  +  C22]=N4<S  (s) 
s 

u(s)  [a33sz+b33s+c33]  =X  n(s) 


(11-11 


setting: 

v(s)=A(s) 

V=A 

^(S)=B(S) 

¥=B 

u(s)  =C(s) 

u=C 

IF1  =  Y<Po^(s)  =--KA1*D1 
IF2=N{rf(s)  =KB1*D1 
IF3  =  Xn  n  (s)  =KC1  *DN1 

Equations   11-11    become: 
ai  lA^-b1  *A+c*  iA+a2iB+b2iB+c2iB=IFl 
ai2AVbi2A+ci  2A+a2  2*B+b2  2B  +  c2  2B=IF2 
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a3  3C  +  b33Oc33C 


=  IF3 


or 


allA+a2iB=I1 


a»2A+a223=l2 
a33C     =13 

where 

I1=-bi iA-c3 iA-b2lB-c2lB+IF1 
I2=~b!2A-c1?A-b22B-c22B+IF2 
l3=-b33c-c33C+IF3 


Solution  of  equations  11-13  yields: 


11  a*«  0 

an  n  o 

12  o.2  ^  0 

ai?  12  0 

«  • 

A  =- 

13  0  a33 

•  • 

B  =  - 

0  13  a33 

•  0 

c  =  - 

A 


A 


with 


A  = 


ali  a21   0 

a12  a22  0 
0    0  a33 


=a33 (aiia2z-ai2a2i) 


(H-12) 


(11-13) 


a*  i  a2*  11 

a  1  2  a22  T2 

0    0   a3  3 


A 


(11-14) 


and  replacing  the  relations  betueen  A,  B,    C  and  the  original 
variables  v,^u, 


v=A=vQ  + 1  Adt 

J=B=i/0+JEdt=i'  +J  [  B0+jBdt  ]dt 


u=C=uft+    Cdt 


(11-15) 
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The  transformation  from  ship  to  space  coordinate 
system  is  defined  by  the  following  relations,  obtained  from 
Figure  II-1 : 

Y=u  Sini  +v  Cos  I 

X  =  u  Cos!  -v  Sin  I 


(11-16) 


from  which 

Y=YQ  +J  Ydt 
X=X  +|Xdt 


(11-17) 


Equations  11-13  through  11-17  were  translated  into 
DSL-360  Computer  program  I.  With  a  constant  rudder 
deflection  6=D1--0.1,  the  results  are  shown  in  Figure  II-2 
(yaw  any!*;  versus  time)  and  Figure  II-3  (sway  versus  surge)  - 
the  characteristic  turning  radius  of  the  ship.  It  must  be 
considered  that  the  described  trajectory  is  valid  only  for 
small  rudder  angles,  since  linear  theory  does  not  give  the 
speed  reduction  in  the  turn  [1  ]. 

5-    Controllability  and  stability  of  the  linear  model 

These  two  concepts  fore;  a  basic  background  to  the 
subject  of  the  qualitative  characteristics  in  the  handling 
of  ships,  since  each  one  takes  into  account  the  intrinsic 
properties  of  a  ship  and  the  transfer  of  initial  state  of 
motion  tc  another  state  in  a  finite  time  [io].< 

a.  Controllability  [ 7  ] 
Considering  the  system 

x(t)=A[x(t),u(t)  ,t]  for  t>t  ,  and  x(t0)=3^ 

(11-13) 
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If   there 


is 


finite   time  t?  >t  and  a  control 


u(t),  t£[tQ#t1  ],  which  transfers  the  state  x  to   the   origin 
at   time   t,  ,  the  state  x„  is  said  to  be  controllable  at  time 

V 

If   all   values  of  x  are  controllable  for  all  tn   , 

o  o  ' 

the    system    is    completely    controllable,    or    simply- 
controllable. 

Kalman  [  6  ]  has  shown  that  a  linear,  time 
invariant  system  is  controllable  if  and  only  if  the  n*mn 
matrix 


e=[  b;  ab:  ab- 


n-1 

;a  b] 


(11-19) 


has  rank  n.  If  there  is  only  one  control  input  (m=1),  a 
necessary  and  sufficient  condition  for  controllability  is 
that  n*mn  matrix  E,  be  nonsingular . 

Taking  equations  II-8  without  including  the  surge 
equation  (because  it  is  decoupled  froi  yaw  and  sway 
equations)  and  dropping  out  the  terms  containing  the 
hydrodynamic  derivatives  Yr  and  N;  in  the  yaw  and  sway 
equations  [  9  ,Pag.  472]  only  to  apply  the  Kalman  Criterion, 
the. state  equations  are: 


V 

Y 

X 

+ 

r 

N 

-hii/a11  -b^/a11 
_bi2/a22  -b2?/a22 


after  performing  the  arithmetic  operations 
\0027     --.0018 


(11-20) 


E 


0012 


-.0085 


which  is  rank  2,  indicating  that  complete  controllability  is 
assured. 
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b.  Stability 

The  stability  test  determines  whether  or  not  the 
ship  returns  to  an  established  equilibrium  condition 
(straight  ahead  motion  at  constant  speed) ,  after  removing 
the  small  disturbance  which  caused  its  departure  from  that 
equilibrium. 

A  dynamically  unstable  ship  cannot  maintain 
straight  line  motion  when  the  rudder  is  amidship. 

The  behaviour  of  the  ship  can  be  analized  by 
considering  either  some  introduced  disturbance  and  zero 
control  input  (o~0)  or  the  control  acting  as  a   disturbance. 

For  the  first  case,  and  neglecting  the  surge 
equation,  equations  II-8  reduce  to 

v  (s)  (a*  is+bi  i)  +r  (s)  (a2is+b2i)=0 

v(s)  (ai2s+bi2)  +r  (s)  (a22s+b22)=0 


(11-21) 


yielding  the  characteristic  equation 
ans  +  bii     a21s+b2* 


a12s  +  t>12 


a22s+b22 


=  0 


or 

(all  a2  2_al2a2i)  S2*  (dI  1 b 22  +  a22b 1  1 -a  1 2b2  l-d2 I bl2)  S 

+ (bJ ib22-b'2b2i)=0 

replacing  values  and  rearranging 

s2-j-0.685s-i-1.  01  6=0 

(11-22) 

both  roots  belong  to  the  left  half   s-plane;   the   ship   has 
fixed  control  stability  with  characteristics  [11  J 
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C0„  =1.00  8 

?  =0.34 

Figure  II-4  shows  the  Root  Locus  corresponding  to 
equation  11-22,  which  is  obtained  with  Fortran  computer 
program  II. 


6 .    The  transfer  functions 

Defining 
£1  i=ai iS2+bl is 

K21=a21S2tb21S 
K*2=al2S2+b12S 

£22=a22S2+b2?S 

K33=a33S2+b33S 

equations  11-11  can  be  written  as 
v(s)  K*a+f  (s)  K21=Y^cf(s) 

V  (SJ  rv---«-X  (^>   *Z  z-Nj.O  id; 

u  (s)K33        =Xnn(s) 

solving  for  v (s) ,  I  (s)  ,  u  (s) 


s 


Yj  cT(s)  K2i  0 
N^cffs)  K21  0 
X,  n  (s)  0  K3  3 


u/ 


(s). 


Kli  Y/J(s)  0 
K*2  Njcf(s)  0 
0  Xn  n  (s)  K3  3 


vhere 


A^ 


K11  K21  0 

K12  K22  0 
0    0  K33 


(11-23) 


uM. 


Kii  K2*  Y,p^(s) 
Ki2  k22  K^cf(s) 
0    0    Xn  n  (s) 


(11-24) 


=K33 (Ki3K22-K12K2i) 


and  replacing  the  K's 
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/\  =  S  (a33  +  b33)[    (S2  (ana22-a12a21)  +s  (  a  1  I  b  2  2  +  a2  2  fa  1  1 

-ai2Di2-a2ib2i)  +  (biib22-b12b21)  ] 

Evaluating    the    solutions   defined    by    equations   11-24 

u(s)     Ku 
n (s)     s+t 

v  (s)     Kv (s+zv) 


<$(s)     s2  +  ps+q 
^(s)     Kr(s+zr) 


o^s)     s(s2  +  ps  +  q) 


(11-25) 


where 


Kv=- 


ys  a2^-N^  a 


2  1 


alla22_a12a21 


Kr  =  - 


Njaii-Yj  a12 


Ku=- 


a33 


zv=- 


zr: 


Yj  b22-Nj b2* 
Yf  a22-Il^a21 

Nj  bi  i-Y^b12 
Mj  ai  i-Y^a12 


b33 

T3~ 


a12b22+a22b11-a12b21-a21b12 


P  =- 


alla22-a12a21 


bi ib^2-b12b21 

alla22_a12a2i 

(11-26) 
The  transfer  functions  defined  by   equations   I.T-25 
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and  11-26,  together  with  the  coordinate  transformation  given 
by  eguations  11-16  and  11-17  lead  to  the  block  diagram 
representation  of  the  ship,  Figure  II-5. 

The  numerical  values  for  the  transfer  functions  are 
those  of  table  II-4. 

TABLE  II-4 

NUMERICAL  VALUES  FOR  THE  TRANSFER  FUNCTIONS 

Kv=  0.21447 
Kr=-1. 91507 

Ku=  0.00588 

zv  =  5.76923 

zr=  1.29369 

p=  0.68467 

q-  1.01659 

t=  0.14117 

B.  TWO  SHIPS  UNDER  FORCE  FIELD  EFFECT 

The  simple  case  where  the  equations  of  notion  of  one  ship- 
were  derived  (II-9)  did  not  take  in  consideration  any 
external  field  forcing  function. 

As  it  has  been  previously  stated,  when  tvo  ships  steam  at 
close  proximity,  the  existence  of  this  Venturi  type  effect 
can  no  longer  be  ignored  [1  ]. 

Calvano  [  4  ]  using  available  information  and  digital 
computer  work  synthesized  the  Force  and  Moment  field  in  a 
set  of  curves,  which  can  be  considered  as  valuab] e 
information  in  the  designing  of  an  automatic  station  keeping 
control  system.  These  curves  are  shown  in  Figures  I.I-6  anci 
II--7  respectively. 

The  major  difficulty  in  handling  these  curves  is  the  fact 
that  they  cannot  be  written  in  a  simple   mathematical   form, 
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but  the  availability  of  digital  computers  minimizes  this 
difficulty  to  the  point  where  they  can  be  stored  as  Discrete 
preknown  information  (Look-up  Table) ,  this  is  shown  in 
DSL/360  program  III,  Subroutine  Slopes. 

All  discussion  concerning  interaction  hydrodynamic 
phenomena,  so  far,  has  been  for  the  Mariner  which  is  assumed 
to  be  ship  A  of  the  two  ship  system, in  Figure  II-8. 

But  hydrodynamic  derivatives  for  both  ships,  at  any 
relative  position  of  interest  are  needed  to  write  the 
equation  of  motion  for  the  multivariable  system.  If  the  two 
ships  are  identical  the  force  or  moment  felt  by  ship  A  at  a 
given  Dx  and  Dy  are  the  negatives  of  the  force  or  moment 
felt  by  ship  B  at  the  same  Dy  at  Dx=-Dx  [4]. 

Defining 

Y=Force    in    ship    A    due    to    ship    B 
Y=Force    in    ship    B    due    to    ship    A 
N=??oinent    in    ship    A    due    to    ship   B 
N=i'iouifen t    in    ihip    B    due    to    ship    A 


then 


.nd 


d*.<*. 

Dv-f\ 


=  -Y 


=-N 


D«r-  W> 

Dy  -    R 


Dx=-co 


(11-27) 


where  06  and  B   represent  numerical  values  in  the  range  of 
interest  of  the  variables  Dx  and  Dy. 

The   equations  of  motion  of  the  two  ships,  coupled  now  by 
the  interactive  effects  can  be  written  as  ioilovs: 

3js)  [a*is2+b»  Jsvcn  ]+l7i(s)  [a2*s2-t-b2is4c2i  J^YjO^S)  -!  Yt(. 
_Vl(s5  [ai2s^-8bi2s+c^]-iY1(s)[a22s2+b22s  +  C22]=M^(fi(s)  +^(3) 

s 

v^s)  [a**s2+b**s+ci»  ]+lr2(s)  [a2iS2  +  b2is4c2i  ]=Y«f  62(s)  +Y2(s) 

I 
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,(s)  [al2S2  +  bl2s  +  c12  j+j^s)  [a2  2s2+b2  2S  +  c2  2  ]=  N^  £,(  S  )  +  N^S) 


U^S)  [a33S2  +  b33s  +  C33] 

s 

U2(S)  [a33s2  +  b33s+c33  ] 


=Xnn1(s) 
=Xnn2(s) 


(11-28) 


in   which   the   coupling   effect   is   implicitly   defined  ny 
equations  11-27. 

1 •    Computer  simulation 

So  far,  the  equations  of  motion  of  two  ships 
coupled  by  the  interactive  effects  (11-28)  are  in  a  neat 
form  to  be  simulated  in  the  digital  computer,  but  it  is 
desirable  to  impose  an  additional  constraint  to  reflect  a 
real  limitation.  There  exists  a  certain  time  lag  between  the 
instant  the  rudder  order  is  given  until  the  action  is 
completed.  This  time  lag  is  taken  as  0.1  (non 
dimensionalized  time,  actual  value  is  2.08  seconds).  Thus 
the  rudder  order  o£)is  modified  to  take  into  account  this 
time  lag. 


s 


(s)  = 


1 


str+1 


h 


(11-29) 


where 


dc!     is    the   desired    rudder   angle 
o       is    the    actual    rudder    angle 
tr    is    the   time   lag 

a.    The   equation    of    motion    of   ship    #    'I     (leading    ship) 
Froa    equations    11-28 

_vi(s)  [aiisz+b^s+ci*  3+S(s)  [a2iS2+b2  is+c**  ]=Yfi  ^(s)  +Y,(s) 

s 

_V](S)  [al2S2-jbl2s  +  c12  J+^S)  [a22S2<-b22S  +  C22  ]  =  N   <?(s)  +  N,(s) 
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JU^S)  [a33S2+b33S+c33  ]  =^^(3) 

s 

(11-30) 

Considering      the      steering      control      as         it        is 
described   by    equation   11-29 

10  4,(3) 


(s)  = 


s+10 


(11-31) 


and   setting 

IF11  (s)=-^ +y,(s) 

0.1s+1  1 

NjOd1  (s) 
IF21  (s)  =-2-1! +w  (S) 

0.1s+1  1 


(11-32) 


The   same    procedure    followed    for    the   derivation   of 
11-12    through   can    be    applied    yielding    as    before 


a11'^  +b*  1A1  4Ci  *A    +a2lB1  +b2lB1  +c2»B1  =IF11 


•  «  *  •  • 


al2A1  +D12A,  +cl2A1  +a22B1  +b22B1  +c22B1  =  IF21 

a33Ct  +b33Cl+C33C1  =IF31 


or    with 

l11  =  -bHA1  -cii  A1  -b2^  -c^Bi  +  IF11 

•  « 

l21  =  -bi2A1  -c*2A1  -b22B1  -c2231  +IF21 

I31=-b33c  -C3  3C,  +IF31 

f cast  ions  11-33  can  be  written  as 
a1  *  A  +a2i*B*i  =11  1 
a*2  A*  +a2  2'B*i  =121 
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(11-33) 


(II- 


a**C,  =131 


(11-35) 


Solving    for    A    ,    B      and   (^ 

••      a22I1  1-a2lI21      ..      ai  iI21-ai2in  ..      131 

A.  = ,    Bt  = ,    C=  

1        aua22-a12a21             1       alla22-a12a21  1         a33 


and   the    original   variables    are   recovered   as    before, 
V1  =Ai=voi+jXdt 

%  =b1  =^+jX  dt=Tt+Jt  vj* ^ dt  idt 
ui  =<=i  =lbi +' ^ dt 


(11-36) 


(11-37) 


so  that  in  the  space  coordinate  system 
Y  =u  SinX,  +v1  Cosi, 


X1  =u  Co  si.,  -v1  Sin  X 1 


Xl=x01+lx.  d1 


(11-38) 


b.  The  equation  of  motion  of  ship  #2  (trailing  ship) 
Since,   from   equations   11-28,   it   is  seen  that 
equations  for  ship  #2  are  the  same  as  for  ship  #1   differing 
only  in  the  subscripts,  this  derivation  is  omitted. 

Equation  of  motion  of  ship  #1  and  ship  2  were 
translated  into  DSL/360  digital  computer  program  III. 

A  piecewise  linear  approximation  of  forces  and 
moments  is  given  by  the  table  look-up  and  the  interpolation 
Subroutine  Slopes.  A  warning  message  is  printed  whenever  the 
distance  between  the  ships  become  less  than  25  feet.  For 
separations  greater  than  250  feet  the  ships  were   considered 
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to   be   outside   of  the  range  of  interest  and  the  forces  and 
moments  assumed  to  be  null. 

2-    ^ESQ  i°.2R  test 

As  previously  mentioned,  the  existence  of  risk  of 
collision  in  the  replenishment  maneuver  is  qualitatively 
well  known  [3  ]  and  it  fixes  the  basis  for  any  attempt  of 
designing  an  automatic  station  keeping  control  system. 
However  a  well  founded  quantitative  analysis  of  this 
particular  subject  is  almost  impossible  to  find  in  the 
current  literature. 

The  open  loop  test  presents  a  quantitative  analysis 
of  the  two  ship  system  behaviour,  and  by  choice  of  different 
initial  conditions  it  detects  the  Collision  Points.  Of 
course,  the  simulated  situation  is  ideal  and  thus  only 
approximates  actual  physical  conditions.  The  analysis  is, 
however,  an  excellent  approximation  to  reality. 

The  simulation  is  ideal  in  the  sense  that  human 
intervention  is  excluded  and  only  the  inherent 
characteristics  of  the  ships  in  the  hydrodynamic  field  are 
evaluated. 

Table  II-5,  indicates  the  tests  performed  to  the 
multivariable  open  loop  system  using  DSL/360  Digital 
Computer  Program  III. 

TABLE  II-5 


Test  # 

1 

2 
3 
U 
5 


U1 


0} 


U2  (0) 


DY  (0) 


DY  (0) 


1„ 

0.2 

-1. 

1. 

0.2 

0. 

1. 

0.  1 

0. 

1.2 

0.  2 

-1. 

1.2 

0.2 

0. 
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Note  that  the  actual  distance  is  obtained  by 
multiplying  the  nondimensional  length  by  the  length  of  the 
ship  (i.e.,  0.2  <=>  0.2*528  feet). 

Figures  II-9  through  11-20  show  the  behaviour  of 
the  two  ships  for  the  conditions  pointed  out  in  Table   II-5. 

Three  important  conclusions  are  obtained  from  the 
analysis  of  the  Figures. 

i)  The  ideal  case,  where  the  equilibrium  conditions 
are  set  at  abeam  position  at  t=0  and  released  at  t=0  (i.e., 
0^  =  02=0)  the  combined  effect  of  Force  and  Moment  fields  tend 
to  pull  the  ships  apart.  It  is  apparent  that  no  collision 
risk  is  involved  (Test  2,  3,  Figures  11-12,  11-13,  11-14, 
11-15)  . 

ii)  The  more  realistic  case  where  the  equilibrium 
conditions  are  set  at  the  Approach  Phase  and  then  released 
(t=0+) ,  the  combined  effect  of  Force  and  Moment  fields  tend 
to  attract  both  ships  and  collision  is  unavoidable,  (it  must 
be  considered  that  after  t=0  no  human  action  is  involved  and 
what  is  observed  in  Test  1  and  4,  Figures  II-9,  11-10,  11-11 
and  Figures  11-16,  11-17,  11-18  correspond  to  the  natural 
behaviour  of  the  ships) . 

iii)  Test  5,  figures  11-19  and  11-20,  shows  the 
Departure  Phase,  where  the  speed  of  ship  #2  is  allowed  to  be 
increased  and  no  risk  of  collision  is  observed. 
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Ill*   THE  AUTOMATIC  CONTROL  SYSTEM 

This  section  starts  with  the  definition  of  a  plant 
with  multiple  inputs  and  multiple  outputs  and  proceeds  with 
mathematical  derivations  until  a  model  for  the  automatic 
control  system  is  obtained. 

A.  THE  MULTIPLE  INPUTS,  MULTIPLE  OUTPUTS  PLANT 

The  initial  equilibrium  condition  for  two  ships  steaming 
at  close  proximity  indicates  that  an  undetermined  o  forcing 
function  is  required  at  t  to  compensate  the  effects  of 
F  (AX  ,  AYQ )  and  M (AX  ,  AY  )  which  are  considered  constant. 
This  definition  is  valid  only  at  t=0  since  there  is  not  any 
logic  that  prevents  o  from  changing  oQ  to  another  value  that 
compensates  increments  of  F  and  M  due  to  variations  of  Ax 
and  AY.  Abkovitz  [  1  ]  has  shown  that  the  force  or  moment 
caused  by  change  in  any  variable  is  expressed  a^  the  product 
of  the  derivative  of  the  force  with  respect  to  that  variable 
(with  all  other  variables  at  equilibrium  values)  and  the 
change  in  the  variable.  Using  this  criteria,  at  t=0  it  is 
required  to  compensate: 


-^F    ^F 
F  (AX,AY)^ — AX+ — AY 
"2>x   -3  y 


and 


M  (AX, AY)  = — AX  +  — AY 
-Sx   3y 


(III-1) 


which  represent  the  "departure"  from  equilibrium  conditions. 
Defining 

U F (AX , AY )  =k *  ° AY+  k  2  o^x 

and 
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"3M  (AX,AY)  =ql<>AY  +  q20AX 


(III-2) 


where  k10,  k20,  q10,  q20,  represent  the  rate  of  change  of   F 

and   M  with  respect  to  AX  and  AY  measured  at  AX„  and  AY  .the 

oo 

longitudinal  and  lateral  separations   from   the   established 
equilibrium  conditions. 

The  linear  expression  f or  ~d  F  and  ~dM  must  be  defined  in 
terms  of  the  variables  ur  v,x  and  then  added  to  the  left 
hand  side  of  equations  11-10  under  the  following 
assumptions: 

a.  The  two  ships  are  identical. 

b.  All  hydrodynamic  coefficients  are  not  affected  by  the 
intermingling  of  the  water  pressure  between  the  ships, 
therefore  remaining  constant. 

c.  The  two  ships  are  considered  alieady  as  being 
alongside  each  other  (AXo=0). 

d.  The  forces  and  moments  acting  on  the  ships  are  equal 
in  magnitude  and  of  opposite  sign. 

e.  The  change  in  forward  velocity  is  considered 
negligible. 

The  increments  AX  and  AY  can  be  expressed  as  given  by 
equations  11-17 

Ax-x2-xi  =J(x2-xi  )dt 

^Y-Y2  -X,  =]{Y2-Y,   )  dt 

Using  equations  11-16 

X2  -X1  =  (u2  CosT2  -v2  SmX2)  -  (u    CosI,  -v,  SinX, ) 

Y2  -T,  =  (u2  Sin%  *v2  CosV  )  -  (u   Sin1^  +^  Coslfx  ) 

(.111-3) 


For  the  small  perturbations  being  considered 


CO: 


.¥* 


Sin?  «0 


3<* 


Cos 


E«i 


siny  «o 

2 


and  equations  III-3  reduce  to 


X  -X  ssO 

2    1 


Y2-Y^v2-Vl 


and  finally 
AX«0 


cJ\j  ^X(s)^0 
4Y^J(v2  -Vi  )dt  oL  AY{s)-l-(v2  -V,  ) 

The   equations   11-10   are   modified 
interaction  effects  and  become 


to    include    the 


j^_(s)  [a*  ls2  +  bi  is  +  c11  ]+$,(s)  [a21s2+b2»s+czl  ]+v2(s)  k=Ys  d(s) 

s  ""5 

v^s)  [al2s2+bi2s+c12  j+Y^s)  [a22s2+b22s+c22]+v2(3)  q=N<jo^(s) 
_^(s)  [ai  »£2+bl  is  +  cii  ]+Y2(s)  [a2is2-5-b2is+c21  3+jMs)  k=Yj  cf(s) 

s  s 

v2(s)  [-a^s^ii-s+ci2  ]+Y2(s)  [a22s2-!  b22s+c22  J+v^s)  q=Njd  <s) 


(III-4) 


where  now 

c11=-k  and  c12=-q 

lettinq 

plO=alJ.s2  +  bl  *S  +  Cl  1 
p20  =  a2iS2^1)25s^c21 
p30=a12S2+b* 2SfC12 

p40=a22s2+b22S^C22 


(III- 5) 


equations  III-4  become 

v^s)  p^o+^s)  p2o  +  v2(s)  k=Yj  c((s) 
_VjJ[s)  p30^i(s)  p*o+_v^(s)  q=N>  cT(s) 
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Vj(s)  k+v2(s)  p*°+%(s)  p20  =  Yj  J2(s) 
_v^s)  g+Vfc(s)  p30+%(s)  p40  =  N(ycf2(s) 


(III-6) 


Equations  III-6  show  that  two  ships  affected  by 
interaction  forces  and  moments  can  be  described  as  a 
multivariable  system  where  the  deflection  of  the  rudders  o^ 
and  d2  are  the  control  inputs  and  the  yaw  angles  X  and  jl  the 
outputs  of  interest.  The  next  following  step  has  as  object 
to  determine  the  form  of  the  entries  of  the  open  loop 
transfer  function  matrix  £  (whose  model  is  shown  in  Figure 
III-1) ,  so  that  the  system  can  be  analyzed  and  modified,  if 
necessary,  to  become  steady  state  decoupled  -after  a 
transient  period  of  time,  a  variation  introduced  in  the 
rudder  angle  of  one  ship  will  not  alter  the  yaw  angle  of  the 
other  . 

From  figure  III-1 


d(£ 


A" 


(S) 


0 


I 


t    G(s) 


g  1  X  g  Z  2 

g21      g22 


n^Y 


(s)  = 


rJ 


or 


¥(3)4 


(s)G(s) 


(III-7) 


_T 


Solving  for  x  (s) 

rV   ^  i-r  S        Si 
[  J^   X2  J-£  o1   o2] 


gll    g!2 
g  2  1    g  2  2 


hence 


X^gii+cfgzi 
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Y2  =  (fgi2  +  (^22 


and   evaluating   the    gains 

2, 


9     17 


0=0  01 


(iri-8) 


cL« 


gl2=7_ 


22  =  .  ^2 


0=0  0    1 


J=o 


so  jG(s)     must    be   of    the   type 


G  (S)  = 


(J,  rfi 

0,  Oo 


(III-9) 


Equation  III-9  gave  the  general  form  of  the  Plant 
matrix  Q.  An  explicit  expression  for  the  entries  of  the  G 
matrix  is  not  needed.  The  steady  state  decoupling  of  the 
states  by  means  of  a  compensator  matrix  Gc  requires  only  the 
knowledge  of  the  number  of  pure  integrators  in  the  entries 
of  G,  this  is  referred  as  the  type  number  of  the  matrix  £5]. 

Solving  III-6  for  cj_«(s)   and  x  0  (s)   and   recalling 


III-l 


V  L911  f1(s)+g2i  (T(s)  ] 

£  (s)  = 1 2 

A 

V  [912  ^(sj+gzs  (f(s)  ] 

X  (s)  =— 

A 


(111-10) 


(111-11) 


where 
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A  = 


plO  p20    k  0 

p30  p40    g  0 

k  0    pi0  p20 

q  0    p3©  p*0 


A  = (pxop40-p20p30)- (gp20-kp*o) 

(111-12) 
where   p10   and   p30   are   second   order   polynomials   in  s 
satisfying 

Lim  p?*0 
s->0 

Thus   the   special   case   of   having   either  k  or  g 

identically  zero  is  avoided. 

X3J 


solving    for  i    (s)     in    III-6 
-C3T  (NSP10-yffP30)  (p»Op*o-paop30j      f 

A 

,  (^p^-H^p^)    (kp30->gpl0)    0  ,x 


(111-13) 


where  A  is  given  by  equation  111-12. 

Replacing   p10,   P2Cr   P30/   P40   as   indicated   by 
equations  III-5  and  taking  separately  gu(s)  and  g22(s) 

&Js)         N«  (a11s2  +  blls+c11)  (a22s2-!b22s+ci-2) 

g1  *  (s)  ■ 


F.-(siis;.:.bi  is+c'  M  (a21s2+b2  *s+c2*)  (a*2s2+b12s+c*2) 

_  _  . 

Y^ai's^flHs+c11)  (a12s2+b12s+c12)  (a2  2s2+b22s +cZ2 ) 

A 
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Yc  (a2is2+b21s+c21)  (a»2s2+bi2s+ci2)  +  Y#  qk (a22s2+b22 s+c2 2) 

A 

Y^q2  (a2iS2  +  b2is+C2i)  4-iycz  (a 2  2 s 2  +  b 2  2 s  +  c2  2 )  - l£,q k  (a2 1  S2  +  b 2  1  S+  C2  i ) 

._  _ 

(111-14) 
and  from  equations  11-10,  11-11 

C21=C22=0 

then  one  s  can  be  factored  out  immediately  in  the  numerator. 
The  independent  term  must  be  also  checked,  if  it  is  equal  to 
zero,  then  another  s  can  be  factored  and  so  on. 

Replacing   c11   by   -k,   and,   c12    by    -q,    the 
independent  terra  becomes: 

N£k2b2  2-N<rkqb2i-Y<rkqb22  +  y5  b^qz+Y^qkb22 

-Ycf  g2b21-N<$>k2b22  +  N<fqkb2i=0 

which  indicates  that  a  second  s  can  be  factored  out  in  the 
numerator. 

Expanding  the  denominator 

A  =S2[  (as3  +  bs2-J-cs-s-d)2-  (es+df  ] 

A=s3[a2s5  +  2abs«+  (b2  +  2ac)  s3+2  (ad+bc)s2 

+  (c2  +  2bd-e)  s  +  2d(c-e)  ] 

where 

a=alla22-a21a12 

b=biia22+a1 lb22-a2lb12 
c=bx ib22-ka2 2+a2lg-b2*b *2 
a=b2*q-kb22 

e=qa2i-ka22 

,  It  can  be  shown  that  the  independent  term  never 
goes  to  zero  for  the  given  values  of  the  hydrodynamic 
coefficient  of  the  Mariner  [  a ]. 
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Hence,  the  highest  factorable  power  of  s  is  s3,  and 


V  (s) 
f,(s) 


g11  (s) 


is   a  type  1  transfer  function  (i.e.,  it  has  one  single  pole 
at  zero) . 

Expanding  the  numerator  of  g2l(s) 

Ng21  (s)  =s[  Yjk  (a22s+b22)  (ai  2S2  +  t,i2s  +  ci  2) 
-kN<f  (a2*s  +  b2*)  (ai2S2  +  bi2s  +  ci2) 

+N^g{ai1s2  +  biis  +  c»1)  (a^s+b-i)  ] 

and  making  the  same  analysis  done  before  for  the  independent 
term: 

-y<j>kgb22+Y<pqkb22-«-kN^L21g-N<rqkb21=0 

which  indicates  that  the  highest  factorable  power   of   s   is 
s2.  Hence  g21(s)  is  a  type  1  transfer  function. 

The  solution  of  equation  III- 11  for  i2{5)  is 


¥,(s)=- 


(Ni'piO-YspSO)  (pi0p^"-p2Cp30) 
J(s) 

A 

(Ysg-Njk)  (kp*o-gP20)  , 

<L(s) 


A 


(Ysp+o-Nf p20)  (kp3o-gpiO)  n 

A 


V 


(III- 15) 


as  could  be  expected  by  symmetry,  T2(s)  nas  tne  same  form  as 
^ (s)  .  As  a  conclusion,  the  type  number  matrix  is  in 
general 


Tp  = 


1 

~1 
1 

1 

1 

(111-16) 


'4  0 


2.    Steady  state  decoupling 


Once  the  type  number  of  the  plant  matrix  £  has  been 
found,  interest  is  concentrated  in  the  determination  of  the 
cascade  compensator  matrix. 

An  important  consideration  that  must  be  made  is  the 
fact  that  the  technique  to  be  used  in  finding  the 
compensator  matrix  does  not  assure  by  itself  stability  or 
good  transient  response  when  the  feedback  path  is  closed. 
Figure  III-2  shows  the  closed  loop  block  diagram,  where  Gc 
is  the  compensator  transfer  function  and  Gp  is  the  plant 
transfer  function,  and 


R(s) 


(fys) 


<ks) 


C(s)  = 


L.   J 

Huang  and  Thaler  [5],  had  shown  that  assuiaing   that 

Gp   is   stabilized  thLough  the  configuratioa  of  Figure  III-2 

then  the  system  is  steady  state  decoupled  if  and  only  if 


lira 
s->0 

for  all  i=1, 


r: 


(I+GpGc] 


T^~ 


det  (I+GpGc) 


(111-17) 

If  Gc  is  a  diagonal  matrix  and  all  inputs  are  steps 
(kj--1)  ,  the  compensator  type  matrix  Tc,  which  gives  the 
number  of  integrators  required  for  steady  state  decoupling 
of "  a  2^2  system  is  obtained  by  satisfying  the  conditions: 

H>N12,  H21 


M>0 


(111-18) 


4  1 


where 


M=MaX[  (tpH  +  tCll)  ,   (tp22  +  tc22)  ,  (tpl1  +  tp22+tGli  +  tc22)  f 

(tp12  +  tp2X  +  tCll+tc22)  ] 
N12^tcl»+tp21 


N21=tc22+tpl2 

from  equation  111-16 

tpl  l=tp!  2  =  tp2  -l=tp22  =  i 

then 

N12-tCl *  +  1 

N2l=tc22+1 

H=Max[  (tcll  +  1)  ,     (tc22+l)#     (2+tc1  lHc22)  ] 


(111-19) 


four    pure 


Considering   that    the    plant    has 
integrators,   no  more  are  required  in  the  compensator  matrix 
then 


and 


tc1 i=tc22=o 


NI2=N21=1 


M=2 

satisfying  the  conditions  established  by  equations  III--18 
From  which: 
r 


Tc- 


0   0 


0   0 


,  Gc= 


g1*   0 
0    g2 


(111-20) 

By  111-16  and  with  111-20,  G   will   have   the   same 
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type  number  matrix  as  Gp,  hence 


1 

f 

T= 

1 

1 

then  G  can  be  written  as 


pi  i 


G= 

AS 


pn  (s)      P12  (s) 


SPA{S) 
P21  (S) 


;P^(s) 

P22(S) 


SPA(S)        3?A(S) 


where   Pa  (s)   and   P^  (s)  r  i,j=1,2  are  polynomials  in  s  such 
that 

Lim  P(s)#0 
s->0 

Tuc      ranae      ^^      normiqihlp      i n du ts    is   determined   by 
means   of    equation    111-18 


pi  i  (s)  +sPa  (s)  P12  <s)  +sPa(s) 


I  +  G  = 


sPa  (s) 


;Pa  (s) 


P2  1(S)+S?a(S)  P22(S)+S?A(S) 


sPa  (s) 


sPa(s) 


det[  I+G  ]=- 


(P11  <s)+sPa(s))   (P22  (s)  +sPA(s)  ) 


(sPa(s)  ) 

(£21    {s)  »■&&  (S)  )    (PI2   (S)  +  SPA(s)  ) 

(sPa(s)) 
P21  (s|»sP<M(:sj) 

s«a  (s) 


U3 


U  +  £3s>i  = 


P12  (S)  +sP£i(s) 
SPA(S) 


lira 
s->Q 


I 


1  [1+5  31,2  1  U  +  fi3a,i 

s^'"0      det[I  +  GJ  s/fci-^    det[I  +  G] 


=  0 


and   after   simplifications 


lii 


^"VMs)4ki^P"(s) 


—    =0 


s~>0      Pi  i  (s)  P22  (s) -P21  (s)  P12  (s) 

» 

(ki,    k2<2) 


(111-21) 


Then      the    system    is    steady    state    decoupled    not    only 
for   step    inputs,    but    also   for   ramp    (k=2)    inputs. 

B.     THE    CLOSED    LOOP    SYSTEM 

Theoretically,  the  steady  state  decoupling  of  the  outputs 
of  the  plant  matrix  has  been  guaranteed  and  the  order  of  the 
system  kept  low  because  no  extra  integrators  were  added  in 
the  compensator  matrix  Gc.  However  there  still  remains  the 
problem  of  satisfying  an  adequate  performance,  which  in  turn 
is    the    main    purpose    of    the    automatic   control   system. 

Lima    [a]    solved    this    problem    by    modifying    the   compensator 
rratrix    to    the   form: 
r 


Gc=* 


g*1  (s+zi *)  C 

0  g22(s  +  z22) 


K1+SKT1 


0 


K2+SKT2 


(111-22) 


and       satisfied      the   desired    performance,    which   was    initially 
stated    in    section    A. 

After      an      exhaustive   analysis    of    the   control   system,    the 
idea   of    increasing    its   capabilities    based    on    the   conclusions 
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coming  next  was  a  feasible  and  attractive  prospect. 

i.  Existing  decoupling  in  the  Surge  equations  of  the 
multivariable  system  allowed  minor  changes  in  their  forward 
speeds  without  appreciable  effect  in  their  trajectories. 

ii.  Equations  11-27  indicated  that  no  additional 
difficulties  were  introduced  by  changing  initial  conditions 
in  the  X  axis  (i.e.,  A^O)  . 

iii.  The  gains  of  the  compensator  matrix  obtained  by 
Parameter  Optimization  Techniques  [  8  ]  allowed  different 
damping  rates  in  their  transient  responses. 

iv .  No  automatic  speed  control  was  required,  since  minor 
changes  in  speed  of  the  trailing  ship  were  easily  made  by 
following  the  acceleration  tables  of  the  ship  (i.e.,  it  is 
assumed  that  the  leading  ship  forward  speed  is  kept 
constant) . 

1 •    Generalization  of  the  muitiy ariable  system  desired 
performance 

Only  a  few  words  are  enough  to  describe  this 
objective.  Beliable  work  of  the  automatic  control  system, 
capable  of  keeping  the  desired  relative  positions  between 
two  ships  from  the  beginning  of  the  replenishment  maneuver 
(Approach  Phase)  to  the  end  of  it  (Departure  Phase)  , 
minimizing  the  risk  of  collision.  Figure  III-3  shows  the 
general  case  uhere  both  ships  maneuver. 

The  variables  of  interest  in  the  control  loop  are 
Y-,'  Y*  J.7  r  IT*  DY*  DY-  Although  DX  and  DX  are  also 
variables  that  must  be  controlled,  they  do  not  affect  in  the 
control  loop,  their  action  is  controlled  manual] y  by 
changing  the  forward  speed  of  ship  #2  until  DX  is  reduced  to 
zero. 

The  design  procedure  is  an  extension  of  the  work 
presented  by  Lima  [o],  in  which  the  ships  were  initially 
considered  steaming  alongside  at  a  lateral  separation 
greater  than  that   required   to   perform   the   replenishment 
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maneuver.  Tne  optimal  gains  as  given  in  Table  III-1  were 
obtained  as  result  of  choosing  the  desired  trajectories  for 
each  ship  and  defining  a  cost  function  to  be  minimized. 
These  values  were  kept  the  same  for  these  studies,  however, 
the  initial  conditions,  specifically  U20,  DX,  and  Y1  and  Y2 
were  cnanged  in  order  to  include  the  Approach  Phase. 

2.    The  controlled  plant  equations 

The  block  diagram  of  the  controlled  plant  is   shown 
in  figure  III-4,  and  the  following  relations  are  obtained: 

p       1    [  (KTY1S  +  KY1)  Y1  (s)  +  (KT1S  +  K1)  Y(s)  ] 
0..(s)  = 1 


d1    trs+1 


(IIJ-23) 


p       1    [KY2  (DY-DFIH)  +KTY2sDY+  (KT2s  +  K2)  ^£(s)  ] 

d  (s) = 

d2    trs+1 

(111-24) 

where  DFIN  is  the  Desired  Final  Lateral  Separation. 

The   fact   that   there   exists   limitations   in  the 

maximum   values   of   the   rudder   angles   [  3  ]   imposed    an 

additional  restriction,  which  is 

|<fj<0.349  or  (<2  0°  )  ;  for  |  d  J  >0  -  349 

11-23  and  11-24  become 


L 


s 


(3) 


trs+1 


*  (0.349) 


,2<s)  = *((K349) 

d^      trs+ 1 


(III-. 


(111-26) 


Digital  computer  program  #4,  which  is  program  S3 
modified  by  including  eguations  III--23  tnrough  111-25  allows 
us  to  make  the  simulation  of  tne  multivarrable  system  now 
implemented  by  the  station  keeping  automatic  control  system. 
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TABLE  III-1 


FEEDBACK  LOOP  GAINS 


Parameter  Run  #1  Run  #2 

U10  1.  1. 

U20  1.2  1.2 

DY(0)  0.4  0.36 

DX(0)  -1.  -1. 

DFIN  0.24  0.3 

K1  2.975  3.069 

KT1  2.775  3.080 

K2  2.917  2.853 

KT2  2.042  2.141 

KY1  3.008  3.320 

KTY1  2.783  2.555 

KY2  1.511  1.533 

KTY2  2.878  2.608 

figures  III-5  through  111-10  show  the  computer 
simulation  results  of  the  controlled  plant.  Both  ships 
reached  the  desired  steady  trajectories  allowing  a  safe,  as 
well  as  precise,  maneuver,  although  a  residual  lateral 
separation  error  exists  (0.02  <=>  approximately  11  feet), 
which  can  be  easily  removed  by  indexing  in  the  hardware. 
Note  that  these  are  not  solely  I.  C.  curves  but  are  tests  of 
system  behayiour  as  ship  2  approaches  ship  1  at  a  for vara 
speed  20/c.  greater  than  that  of  ship  1.  The  initial  la: 
excursion  of  ship  1  is  due  in  part  to  the  large  moment 
caused  by  the  pressure  field,  and  in  part  by  the  chosen 
initial  conditions. 
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IV«   A  NEW  OPTIMIZATION  CRITERIA 

The  preceeding  section  led  to  the  final  design  of  the 
automatic  control  system.  A  basic  assumption  was  made  in  the 
sense  that  the  feedback  gains  were  kept  unchanged  from  the 
optimals  obtained  by  Lima  [ 8  ]. 

Computer  simulation  demonstrated  that  the  assumption 
made  was  good  enough  to  allow  the  two  ship  system  to  satisfy 
the  desired  performance.  However  the  trajectories  can  no 
longer  be  said  to  be  optimal,  since  cocipletely  different 
initial  conditions  were  imposed.  To  overcome  this  fact  two 
technigues  were  considered  -the  first  one,  to  reformulate 
the  optimization  study  incorporating  trie  new  initial 
conditions,  and,  the  second,  to  use  the  actual  gains  and  to 
originate  a  systematic  procedure,  basically  Trial  and  Error, 
to  determine  not  optimal,  but  quasi-optimal  gains. 

Because  it  was  expected  that  the  range  ex"  variation  of 
the  parameters  would  be  reasonably  s.  ill,  the  second 
procedure  was  adopted.  Of  course,  the  Trial  and  Error 
procedure  has  the  disadvantage  that  r  :.ny  statistical 
combinations  are  ignored,  but,  on  the  other  hand  experience 
gives  a  high  degree  of  confidence  in  a  systematic  computer 
trial  procedure. 

A.  TRIAL  AND  ERROR  PROCEDURE  FOR  QUASI-OPTIBIZATION  OP  THE 
GAIN  PARAMETERS 

Selecting  the  time  basis  trajectories  shown  by  Figures 
III- 8  and  I I I- 9  the  new  objective  is  to  smooth  Sway  and  Yaw 
transient  responses.  Note  that  the  same  ;.  ;;ocedure  applies 
to  Figures  III-5  and  III- 6. 

From  Figure  III-4,  a  Procedure  Flow  Chart  was  made  which 
includes  all  the  possibilities  of  discrete  changes  in  the 
K's  parameters  in  the  range  0  to  100;.  ...y  increasing  its 
values. 
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The  possibility  of  decreasing  the  K's  values  was  left  out 
because  it  was  estimated,  cased  on  linear  theory,  that  it 
would  not  meet  the  requirements. 

Figure  IV-1  shows  the  Trial  Procedure  Flow  Chart. 

From  computer  simulation,  many  runs  were  done  using 
DSL/360  computer  program  #5  but  after  the  selection  of  the 
"best  set",  graphs  of  Run  #1  through  Run  #4  were  considered 
important  enough  to  be  included  for  purpose  of  analysis. 
Note  that  all  of  these  simulation  runs  were  made  with  the 
trailing  ship  approaching  the  leading  ship  at  a  speed  20% 
greater  than  that  of  the  leading  ship. 

B.  TRIAL  AND  ERROR  PROCEDURE  RESULTS 

Table  IV-1  shows  the  gain  parameters  for  the  four  main 
runs  of  the  Trial  Procedure  Flow  Chart.  Figures  IV-2  through 
IV-9  are  the  computer  output  for  this  stepped  procedure. 

The  decision  of  the  best  set  of  K's  was  somewhat 
subjective  and  based  principally  on  the  shape  of  the 
corresponding  computer  output  curves.  A  qualitative 
analysis  of  the  Sway  and  Yaw  curves,  however,  indicates  that 
there  is  a  definitely  improvement  in  the  smoothness  of  the 
transient,  Figures  IV-8  and  IV-9  being  considered  the  best 
set,  as  may  be  seen  by  comparison  with  Figures  III-8,  III-9. 

Figures  IV-8  and  IV-S  are  the  most  important  because  they 
assure  that  the  systematic  Trial  and  Error  procedure  was  an 
excellent  tool  to  obtain  quasi-optimal  gains  for  the 
specific  initial  conditions  of  the  Generalized  Desired 
Performance  described  in  section  III. 
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TABLE    IV-1 


FEEDBACK    LOOP    GAINS    FROM    TRIAL    PROCEDURE 


Parameter 

Run    #1 

Run    #2 

Run    #3 

Run    #4 

KT1+50% 

KTY1+50% 

KY2+25% 

K1+15% 

mo 

1. 

1. 

1. 

1. 

U20 

1.2 

1.2 

1.2 

1  .2 

DY  (0) 

0.36 

0.36 

0.36 

0.36 

DX  (0) 

-1. 

-1. 

-1. 

-1  . 

DFIN 

0.3 

0.3 

0.3 

0.3 

K1 

3.06  9 

3.069 

3.069 

3.52935 

KT1 

4.62 

4.62 

4.62 

4.62 

K2 

2.853 

2.853 

2.853 

2.853 

KT2 

2.  141 

2.  141 

2.14  1 

2.  141 

KY1 

3.320 

3.320 

3.320 

3.320 

KTY1 

2.555 

3.8325 

3.8325 

3.8  3  25 

KY2 

1       c  'J   -> 
1  •  oo  -J 

1  .  533 

1.91625 

1  .91625 

KTY2 

2.608 

2.608 

2.608 

2.608 
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V •   CONCLUSIONS 

It  has  been  demonstrated  that  the  intrinsic  dynamics  of 
ships  steaming  at  close  proximity  is  unstable,  the  Approach 
Phase  of  the  replenishment  maneuver  being  of  particular 
interest,  where,  excluding  human  intervention,  collision  is 
unavoidable. 

The  mathematical  modeling  of  two  ships  as  one  system 
with  multi-inputs  and  multi-outputs  has  proven  to  be  a 
powerful  technique  in  the  study  of  the  dynamic  behaviour  of 
vehicles  coupled  by  a  common  media. 

The  station  keeping  control  system,  initially  based  on  a 
previous  concept,  was  tested  under  different  conditions, 
and,  significant  modifications  were  introduced,  mainly  in 
the  gain  parameters  of  the  feedback  loops,  to  satisfy  the 
aims  of  safety  as  well  as  precision  in  the  whole  maneuver. 

To  avoid  increasing  the  order  of  the  general  system 
equations,  nc  forward  speed  control  was  included,  being 
assumed  that  the  forward  speed  would  be  controlled  manually 
as  is  actually  done. 

Even  though  the  design  of  the  hardware  was  not  intended, 
it  is  estimated  that  a  Modular  System  composed  of  a  Doppler 
Sonar,  a  Gyroscopic  Element  and  probably  a  Digital  Logic 
would  be  suitable  in  its  realization. 
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Figure  II-1.   Orientation  of  the  Space  Axis  (Xo,  Yo) 
and  the  Moving  Axis  (X,  Y) * 
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NONDIMENSIONAL  Y  FORCE  VS  A  AT 
SIDE-TO-SIDE  DISTANCES.  B, OF  50,60, 
70,  SO,  90  AND  100  FT. 


FORCE  ON  SHIP  A  AS  SHIP  B  PASSES 
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//ASTOZ  JOB  i 1025,0732, EA32 ) , 'ASTORQUIZA* ,TIME=4 
//  EXEC  DSL 
//DSL. INPUT  DD  * 


*  COMPUTER    PROGRAM     I 

*  LINEAR    RESPONSE    OF    THE    MARINER 

INTEG    TRAPZ 
INTGER    NPLOT 
CONST    NfLOT=l 

*  HYDRODYNAMIC  COEFFICIENTS 

CONST  NR=-0.0O2  2  7,NV=-O.O03  51,NVD=-0.00  0197 

CONST  MYVD=0.0J.5,MYR  =  0.O051»  I  ZNRD=0  .  000  78,  MX  J  0  =  0  .  00  3  5 

CONST  YV=-0.0  1243,XU=-0.0012,YRD=-0.002  7 

CONST  YDELR=-0.0027f NO ELR=- 0.00 126 fXN=. 00005 

*  RUDDER  DEFLECTION 
PARAM  D1  =  0. 1 

*  INITIAL  CONDITIONS 
INC ON  XO=0.»YO=0. 
INITIAL 

PARAM  UD1=1. 

*  CALCULATION    OF    THE    COEFFICIENTS 

A  1.1  =  MY  VD 

B11=-YV 

A21=-YRD 

B21=MYR 

A12=-NVD 

B12=-NV 

A2  2=I ZNRD 

B22=-NR 

A33=MXUD 

B33=-XU 

NC=-XU 

KA1=- YDELR 

KB1=NDELR 

KC1=26.*XN 

D=A11*A22-A12*A21 

IF1=KA1*D1 

IF2=K81*D1 

IF3=KC1*UD1 
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DERIVATIVE 

*      TIME  DOMAIN  SIMULATION 

U=-B1  l*ADOT~B21*BDOT+IFl 

I2=-B12*ADCT-B2  2*SDOT+IF2 

I3=-B33*CD0T+IF3 

ADDOT= ( I 1*A22-I2*A21  )/D 

BDD0T=(I2*A11-I 1*A12)/D 

CDDOT=  I3/A33 

ADOT=INTGRL(0. , ADDOT) 

BDOT=INTGRL(0. ,BDDOT) 

CDOT=INTGKL(l. ,CDDOT) 

A=INTGRL(0. ,ADOT) 

B=INTGRL(0.,BDOT) 

C=INTGRL(0. ,CDCT) 

XDOT=CDOT*CCS(8)-ADOT*SIN( 3) 

YDOT=CDOT*SIN(B ) +ADOT*COS ( B ) 

X=INTGRL( XO,XOOT) 

Y=INTGRL(YO,YDOT) 

YAW=B 

SWAY=Y 

SURGE=X 
SAMPLE 

CONTRL  FINTIM=30. ,DELT=0.04,DELS=0.04 
PREPAR  1.  , SURGE, SWAY , YAW, USPEED 
GRAPH  TIME, YAW 
GRAPH  TIME, SWAY 
GRAPH  TIME, USPEED 

GRAPH  SAME, 10 » 10, SURGE, SWAY, USPEED 
PRPLOT  CNLY 

CALL  DRWG( 1,1, TIME, YAW) 

CALL  DRWGl 2 , 1 .SURGE , SWAY ) 
TERMINAL 

CALL  ENDRWdMPLOT) 
END 
STOP 

//PLOT.STEPLIB   DD   DSN=SYS3 . DSLPLOT, UNIT=232 1 , VOL=SER=CELOO 
//PLOT.SYSIN  DD  * 
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//ASTOF  JOB  ( 1025, 0732, EA32) , ' AS TORQU I Z A' , TIME=20 
//  EXEC  DSL, REGION. C=150K 
//DSL.FT06F001  DD  SPAC E= ( TRK , ( 5 , 1 ) ) 
//DSL. INPUT  OD  * 


COMPUTER  PROGRAM  III 


OPEN  LOOP  SYSTEM  RESPONSE 


INTEG  TRAPZ 
INTGER  NPLOT 
CONST  NPL0T=5 


HYDRODYNAMIC  COEFFICIENTS 


PARAM  MXUD=-0. 0085, XU=-0. 0012 
PARAM  MYR=-0. 0051, YRD=-0. 0027 
PARAM  YV=-0.  0  12^-3,  MYVD=- 0.0  15 
PARAM  NVD=-0.00  019  7,NV=-0.003  51 
PARAM  NR=-0. 00227, I ZNRD=-0. 00  078 
PARAM  YDEL-O. 0027, hDEL=-0. 00126 
PARAM  XN=. 00005 


*  INIiIAL  CONDITIONS 

INCON  Y10=-.l ,Y20=.l 

INCON  XlO=l. ,X20=0. 

INCON  U10=l. »U20=1 . 

PARAM  DD1=0. ,DD2=0. 

PARAM  DN1=0. ,DM2=0. 

PARAM  YY1=0. ,YY2=0. , YN1 =0 . , YN2=0 . 

INITIAL 

*  CALCULATION  OF  THE  COEFFICIENTS 


A11=-MYVD 

B11=~YV 

A21=-YRD 

B21=-MYR 

C11=0. 

C12=0. 

C21=0. 

A12=-NVD 

B12=-NV 

k22--~\  ZNRD 

B22=-NR 

C2?.  =  0. 

A33=-MXUD 

B33--=-XU 

P=A33/633 

KC1=XN 

KKi=KCl/B33 

KA=YDEL 

KB=MDEL 

D=A11*A22-A12*A21 
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INITIAL     SEPARATION 


DYO=Y20-Y10 
DXO=X20-X10 


CALL    SLOPES(DXO,DYO,YYl, YY2»YN1,YN2) 


DERIVATIVE 

*  SIMULATION 


DX=X2-X1 

DY=Y2-Y1 

YDOTl  =  COOTl*SIiN(Bl  )*ADOTl*COS(  Bl) 

YDOT2=CDOT2*SIN(B2)+ADOT2*COS<  B2) 

XCOTl=CDOTl*COS( Bl ) - ADOT 1* SIN { 3 1 ) 

XDOT2=CDCT2*COSlB2)-AOOT2*SIN(62» 

ADD1=( A22*I il-A21*I21)/D 

ADD2=( A22*I12-A2  1*I22)/D 

6001= ( A11*I2  1-A12*I11)/D 

BDD2=( A11*I22-A12*I 12) /D 

AD0T1=  INTGRHO.  ,  ADD1  ) 

AD0T2=INTGRL(0. , ADD2) 

BD011= INTGKLiO. , B001 ) 

BDOT2=INTGRL(0. ,3002) 

CD1=REALPL<0. ,P,KK1*DNI) 

CD0T1=U10+CD1 

f*  1^  *5  —  3  C   A  I     D !     i  f\  "       i/  i/  i  j-r\Mi  1 

LU^-f\^riLM.»U.   |  t    tl\i\l'''L;ivtj 

CDGT2^U20 

Al=INTGRL(0,tADOTU 
A2=INTGKL(0. ,AD0T2) 
B1=INTGRL(0.,BD0T1) 
B.2=INTGRL(0.,BD0T2) 
Y1=INTGRL(Y10,YD0T1) 
Y2=INTGRL(Y20,YDOT2) 
X1=INTGRL(X10, X00T1) 
X2=INTGRL(X20,XDOT2) 

I11=-B11*A00T1-C11*A1-B21*BD0T1-C21*BUIF11 
I12=-3  11*ADOT2-Cll*A2-B21*BDOT2-C21*B2*IF12 
I21=-3  12*AD0T1-C  12*A  1-B22*BD0T 1-C22*B!  MF21 
I22=-B12*AD0T2-C12*A2-B22*BD0T2-C22*B2MF2  2 
AF1L=REALPL(0.  ,0.1,KA*DD1) 
AF 1 2  =R  E  A L PL  I  0  .  ,  0  . 1 ,  K  A*DD2  ) 
:     21=REALPL(0. ,0.1tKB*001) 
^2=REALPL(0. ,0.1,KB*DD2) 
IF11=AF1H-YY1 
IF12=AF12*YY2 
IF21=AF21+YN1 
IF22=AF22+YN2 
B1G=57„3*B1 
B2G=57.3*B2 


DYNAMIC 

*  ACTUAL    SEPARATION 


DX=X2-X1 
DY=Y2-Y1 


CALL    SLOPES (DX,DYfYYl,YY2,YNl,YN2) 
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SAMPLE 
PRINT 
PREPAR 
CONTRL 


. 036,DX,DY,YYl, YY 2 , YN 1 , YN2 , BIG , B2G , X 1 , X 2 
.0018, BiG,B2G,Yl ,Y2 
FINTIM=3.2,DELT=.0018,DELS=.0018 
IF(ABS(DY) .LE.. 05) WRITE (6,3) 


CALL 
CALL 
CALL 
TERMINAL 

CALL 


FORMAT {  -  -  , 
CALL  DRWGd 
DRWG( 1 


LATERAL     SEPARATION 
tit  TIME,  YD 


LESS    THAN    25    FT1  ) 


,2fTIME,Y2) 

ORWG( 2,1,TIMET31G) 
DRWG(2,2,TIME,8  2G) 

ENDRW  (NPLOT) 


END 

INCON 

INCON 

PARAM 

END 

PARAM 

END 

PARAM 

END 

PARAM 

END 

S70P 

//C.SY 

//PLOT 

//PLOT 


Y10=-.l ,Y20=.l 
U10=l. ,U20=1. 
X10=0. ,X20=0. 

Y10=-.  0  5,Y20=.05 , XI 0=0. ,X20  =  0. 

U 20  =  1.  2 ,Y10=-.1,Y20=.1,X10=1.,X20  =  0. 

U20=1.2,Y10=-.l, Y20=. 1, XI 0=0. ,X20=0. 


SPRINT  DD  SPACE=(TRK,(  2,2)  ) 

.STEPLI6   DD   DSN=SYS3.DSLPLOT,UNIT=2321tV0L=SER=CEL00 

.SYS IN  DD  * 
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SUBROUTINE    St  OPE S (DX ,DY , YY 1 1 YY2 , YN1 , YN2 } 
TABLE    LOOK-UP    AND    INTERPOLATION 


DIMENSION    Z(23,16),W(23,16),X(23)»Y(16) 

X(l)=-l.l 

X<2)=-1. 

X(3)=-.9 

X(4)=-.8 

X<5)=-.7 

X(6)=-.6 

X(7)=-.5 

X(8)=-.4 

X(9}=-.3 

X(10)=-.2 

X(ll)=-.l 

X(12)=0. 

X(  13)=. 1 

X(14)=.2 

X(15)=.3 

X(  16)=. 4 

XU7)  =  ,5 

X  (  1 8  )  =  .  6 

X( 19)=. 7 

X(20)=,8 

X(21)=.9 

X(22)=l. 

X(23)=l.l 

Y(1)  =  0.  10 

Y(2)=0.12 

Y(3)=0.14 

Y(4)=0.16 

Y(5)*0.18 

V  //-_»_  A       o 
I    »>.->/   --  w  •  <u. 

Y(7)=0.22 
Y(8)=0.24 
Y(9)=0.26 
Y(10)=0.28 
Y(ll)=0.30 
Y(  i?J  =  0.32 
Y(13)=0.34 
Y( 14>=0.36 
Y(15)=0.38 
Y( 16) =0.40 
2(1,1) =0. 
Z<1,2)=0. 
Z(l,3) =0, 

u  i,4;=o. 

Z<1,5J=0. 
Z(lr6) =0. 
Z(l,7)=0. 
Z(l,8)=0. 
Z ( 1 , 9  J =0. 
Z(1,.10J=0. 

z(iai)=o. 

Z{ 1,12  >=0. 
li  1*13 )=0. 
Z  i  i  ,  1 4  )  =  0  . 
Z  i  1 , 1 5  J  =  0  . 
7.  (  I . ,16)=0. 
HZ,  1)  =-24. 
H 2, 2)  =-21  . 
li  2 ,  3 )  =- 1 9 . 
Z<2,4)=-21. 
Z(2,5)=-15. 
Z  ( 2 , 6 »  =- 1 4 . 
Z(2f7)=~12. 
Z(2,8)=-10. 
Z<2,9)=-8. 
Z(2? 10)=- 6. 
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Z(2,ll)= 
Z(2,12)= 
Z<2,13)= 
Z(2,14)= 
Z(2,15)= 
Z<2,16)= 
Z(3,l)=- 
Z(3,2)=- 
Z(3,3)=- 
Z(3,4)=- 
Z(3,5)=- 
Z<3,6)=- 
Z<3, 7) =- 
Z(3,8)=- 
Z(3,9)=- 
Z(3,10)= 
Z(3,ll  )  = 
Z(3,12)= 
Z(3, 


Z<3, 
Z(3, 


Z( 
Z( 


1) 

2)  = 

3)  = 


13) 
14) 
15) 
Z(3,lo) 
Z<4, 
4, 
4, 
Z(4,4)= 
Z(4,5)= 
Z(4f6)= 
Z(4, 7)= 
Z(4,8)= 
Z(4,9)= 
Z(4,10) 
Z  (  4 , 1 1  ) 
Z  <  4 , 1  2  ) 
Z  (  4 ,  1 3  ) 
/.  i i  ^  »  i  H- )  = 
Z  (  4 ,  ]  5  )  = 
Z<4f 16)= 
Z(5, 1)=- 
Z ( 5 , 2 ) =- 
ZC5,3)=- 
Z(5f4)=- 
Z(5,5) =- 
Z(5,6)=- 
Z(5,7)=~ 
Z(5,8) =- 
Z(5,9)=- 
Z(5,10) 
Z(5, 
Z<5, 
Z(5, 
Z(5, 
Z  (  5  , 1 5  ) 
Z(5il6) 
Z(6f  1)  = 
Z(6,2)= 
Z(6,3)= 
Z  ( 6 ,  4 )  = 
Z(6,5)= 
Z(6,6) = 
Z(6f 7) = 


il) 
12) 

13) 
14) 


Z(6, 


) 


9)=~ 

10)  = 

11)  = 

12)  = 


Z  (  6 , 
Z(6, 
Z<6, 
Z(6, 

Z  {  6  , 1  3  ) 
Z  (  6  ,  1 4  ) 
1(6, 
Z(6, 
Z(7, 


15)- 
16)- 
1)  = 


Zi7,2)=- 


-4. 

-2. 

0. 

0. 

0. 

0. 

35. 

29. 

26. 

22. 

18. 

16. 

14. 

12. 

10. 

-8. 
=  -6. 
=  -4. 
=-2. 
=  0. 
=  0. 
=  0. 
-39. 
-33. 
-£.  o . 
-23. 
-18. 
-16. 
-14. 
-12. 
-10. 
=-8. 
=-6. 
=-4. 
=  -2. 
=  0  • 
=  0. 

0. 

38. 

31. 

26. 

21. 

18. 

14. 

12. 

10. 

8. 

-6. 

-4. 

-2. 

0. 

0. 

0. 

0. 

28. 

24c 

20. 

15. 

12. 

10. 

8. 

6. 

4. 

-2. 

0. 

0. 

0. 

0. 

0. 

0. 

15. 

11. 
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Z(7,3) =-9. 

Z(7,4)=-6. 

Z(7,5)=-4. 

Z(7,6)=-2. 

Z(7,7)=0. 

Z(7,8)=0. 

Z(7,9J=0. 

Z(7,10)=0. 

Z(7,ll )=0. 

Z(7,12)=0. 

Z(7,13)=0. 

Z(7,14)=0. 

Z<7,15)=0. 

Z(7,16)=0. 

Z<8,1)=4. 

Z(8,2) =6. 

Z(8,3)=7. 

Z(8,4)=3. 

Z(8,5)=9. 

Z(8t6) =10. 

Z<8,7)=7. 

Z(8,8)=6. 

Z(8,9)=4. 

Z(8,10)=2. 

Z(8,ll  )=0. 

Z(8,12)=0. 

Z(8,13)=0. 

Z<8,14)=0. 

Z<8,15)=0. 

Z(8,16)=0. 

Z(9,l)=27. 

Zi9,2)=25. 

Z(9,3)=23. 

Z(9,4)=22. 

Z(9,5)=21. 

-7    i    /~»        '    »          -»  r\ 

L\    V  ,  U  I    -  £.U  • 

Z  (  9 1  7  i  =  1 8  • 

Z(9,8)=16. 

Z(9,9>=14. 

Z(9, 10)=12. 

Z  (  9 ,  1 1 J  =  1 0 . 

Z<9,12)=8. 

Zt9,13)=6. 

Z<9,14)=4. 

Z(9,15)=2. 

Z(9il6)=0. 

ZllOt 1 ) =52- 

Z( 10,25=47. 

2(10,3) =43. 

Z( 10,4)=39. 

Z( 10, 5>=36. 

Z( 10,6)=34. 

Z(10, 7) =32. 

Z( 10, 8)=30. 

Z( 10, 9) =2 8, 

Z( 10, 10) =26. 

Z< 10, 11)=24. 

Z( 10,12)=22. 

Z( 10, 13) =20. 

Z( 10, 14) =13. 

Z(10,  15)  =  16. 

Z( 10, 16) =14. 

Z(ll, 1)=72. 

Z( 11,2 )=64. 

Z( 11, 3) =5 8. 

Z  ( 1 1  ,  4  )  =  5  2 . 

ZU1,  5)  =46. 

Z( 11, 6) =43. 

Z( 11,7 )=40. 

Z( il,8)=37. 

Z( 11, 9) =34. 

Z  ( 1 1  , 1  0  J  =  3 1  . 

1C2 


z< 

11. 

1 1 J  =  28. 

z< 

Ill 

12)=25. 

Zl 

111 

13)=22. 

Zl 

111 

14)=19. 

Zl 

11. 

15)=17. 

Zl 

11 1 

16)=15. 

Zl 

12, 

1)=86. 

Zl 

12, 

2)=75. 

Zl 

.12, 

3)=67. 

Zl 

12, 

4)=60. 

Zl 

12, 

5)=53. 

Zl 

12, 

6)=48. 

Zl 

12, 

7)=43. 

Zl 

12, 

3)=39. 

Zl 

l12, 

9)=35. 

Zl 

;  12, 

10)=32. 

z 

112, 

11)=29. 

Zl 

.12, 

i2)=26. 

Zi 

[12, 

13)=23. 

Zl 

[12, 

r 14)=20. 

Zl 

[12, 

r 15) =18. 

Zl 

[12, 

16)=16. 

Zl 

[13, 

1 )=S9. 

z 

[13, 

2)=78. 

Zl 

13, 

3)=69. 

z 

13, 

4)=60. 

z 

[13, 

5)=53. 

z 

.13, 

6)=48. 

z< 

[13, 

7)=43. 

7< 

r  13, 

,8}=38. 

z 

13, 

9)=34. 

z 

13. 

r 10 )=31 . 

z 

[13, 

,11)=2S. 

z 

[  13, 

12)=25. 

z 

[  13, 

, 13)=22. 

z 

[13, 

t  1 4 }  -  1  9  • 

z 

[13, 

»  15)=17. 

z 

[13. 

r 16)=15. 

z 

[  14, 

,1)=80. 

7 

[14, 

2J=70. 

z 

114, 

,  3)=63. 

z 

[14, 

4 )  =  5  5 . 

z 

[14, 

,5)=50. 

z 

;i4, 

,6)=45. 

z 

[14 

r 7)=40. 

z 

[14, 

,8)=36. 

z 

[14, 

r9)=33. 

z 

[  14. 

r!0J=30. 

z 

[  14 

r  11)=29. 

z 

[14 

,12)=26. 

z 

[14 

t 13)=23. 

7 

[14 

r 14)=20. 

z 

[14 

r  1  5  }  =  1  8  . 

7 

[  14 

, 16)=16. 

z 

[15, 

,  1)=64. 

z 

[15- 

r2)=56. 

z 

[  15. 

-3)=51. 

z 

[15 

,4)=46. 

z 

115 

, 5} =4  1. 

z 

[15 

,6)=38. 

I 

[  15, 

■7)=36. 

I 

(1.5 

,81=34. 

7 

[  15 

P9)=32. 

1 

(15 

r 10)=30. 

z 

(15 

,  11)=28. 

z 

(  15 

,  12)  =  26. 

z 

(  15 

,13) =24. 

z 

(  15 

i 14)=22. 

z 

(  15 

,  15)  =  20. 

7 

(15 

, 16)=18. 

z 

(16 

rl )=45. 

z 

(  16 

,2) =41. 
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Zl 

[16, 

Zl 

16, 

Zl 

[  16, 

Zl 

116, 

Zl 

16, 

Zl 

il6, 

Zl 

16, 

z 

16, 

z 

16, 

z 

;  16, 

Zl 

;  16, 

Zl 

16, 

Zl 

L  16  , 

Zl 

16, 

Zl 

17, 

Zl 

[17, 

Zl 

17, 

Zl 

17, 

Zl 

[17, 

Zl 

17, 

Z 

117, 

Zl 

17, 

Zl 

17, 

Zl 

17, 

z 

17, 

Z( 

17, 

z 

,17, 

Zl 

,17, 

L 

17, 

Zl 

,17, 

Z( 

18, 

Z 

[18, 

z 

18, 

Zi 

18, 

Zi 

.18, 

I.  1 

.  18  , 

z< 

[16, 

Zl 

,18, 

Zl 

18, 

L 

[18, 

Zs 

18? 

Zl 

18, 

Zi 

18, 

z. 

18, 

Z< 

,18, 

Zl 

[18, 

Zl 

19, 

/ 

[19, 

Zl 

19, 

z 

19, 

z 

39, 

Zl 

19, 

Zl 

,19, 

z 

'19, 

z 

19, 

7  j 

.19* 

Zl 

[  19, 

Zl 

,  19, 

I 

[19, 

I 

.19, 

7 

19, 

l\ 

119, 

z 

20  j 

z 

20, 

z 

.20, 

z 

[20s 

z 

:2o. 

?: 

[20, 

z 

[20, 

7 

120, 

z 

[20, 

z 

120, 

3)  = 

4)  = 

5)  = 

6)  = 

7)  = 

8)  = 

9)  = 
10) 
11) 
12) 
13) 
14) 
15) 
16) 
1  )  = 

2)  = 

3)  = 

4)  = 

5)  = 

6)  = 

7)  = 

8)  = 

9)  = 
10) 
11) 
12) 
13) 
14) 
15) 
16) 

1)  = 

2)  = 

3)  = 

4)  = 

5)  = 
6)- 

7)  = 

8)  = 

9)  = 
10) 
11) 
12) 
13) 
14) 
15) 
16) 

1)  = 

2)  = 

3)  = 

4)  = 

5)  = 

6)  = 

7)  = 

8)  = 

9)  = 
10) 
1  1) 
12) 
13) 
14) 
15) 
1  6) 

1)  = 

2)  = 

3)  = 

4)  = 

5)  = 

6)  = 

7)  = 
81  = 
9J  = 
10) 


38. 

35. 

33. 

30. 

28. 

26. 

24. 

=  22. 

=  20. 

=  18. 

=  16. 

=  14. 

=  12. 

=  10. 

30. 

28. 

26. 

24. 

23. 

2?. 

20. 

18. 

16. 

=  14. 

=  10. 

=  io. 

=  8. 

=  6. 

=  4. 

=  2. 

17. 

17. 

16. 

16. 

16. 

16. 

15. 

15. 

15. 

=  14. 

=  14, 

=  14. 

=  12. 

=  12. 

=  12. 

=  10. 

6. 

7. 

7. 

8. 

8. 

9. 

9. 

8. 

8. 

=  7. 

=  6. 

=  4. 

=  5. 

=  3. 

=  2. 

=  0. 

-5. 

-4o 

-3. 

-j  . 

0. 

0. 

0. 

0. 

0. 

=  0. 
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Zl 

20,11)=0. 

Zl 

20, 12)=0. 

Zl 

20f13)=0. 

Zl 

20, 14)=0. 

n 

20, 15)=0. 

Zl 

20,16)=0. 

Zl 

21,l)=-5. 

Zl 

21,2)=-4. 

Zl 

21,3)=-3. 

Zl 

21,4)=-1. 

Zl 

21,5)=0. 

Zl 

21,6}=0. 

Zl 

21,7)=0. 

Zl 

21,&)=0. 

Zl 

21,9)=0. 

Zl 

21,10J=0. 

Zl 

21,11)=0. 

Zl 

21,12)=0. 

Zl 

21,13)=0. 

Zl 

,21,14)=0. 

Zl 

21,15)=0. 

Zl 

21,16)=0. 

Zl 

22,1 )=-6. 

Zl 

22,2)=-5. 

Zl 

22,3)=-5. 

Zl 

22f 4)=-4. 

Zl 

22,5)=-4. 

z< 

22f6)=-4. 

z 

22,7)=~3. 

Zl 

22,8)=-3. 

n 

22,9)=-2. 

I 

,22,10)=-2. 

Zl 

22,1 1)=-1. 

z 

'22,12)=-1  . 

Zl 

. 22,13) =-1. 

-7 

i. 

22,14)=0. 

Z  i 

22,15)=0. 

Zl 

22,16)=0. 

u 

23, 1 )=0. 

Zl 

23,2 )=0. 

Zl 

23,3)=0. 

z  * 

23,4] -0. 

z 

[23,5)=0. 

Zl 

23,6)=0. 

7. 1 

23, 7) =0. 

z 

L23,8)=0. 

Zl 

23,9)=0. 

Zl 

23,103=0. 

L 

23,1 1)=0. 

Zl 

23,12)=0. 

z 

23,13)=0. 

z 

,23, 14J=0. 

Zl 

235 15)=0. 

Zl 

:23»16)=0. 

Wl 

l,l)-0. 

Vi 

1,2)=0. 

H 

1,3) =0. 

w 

[ 1,4) =0. 

',' 

; i,5)=o. 

I.1 

1,6)=0. 

W 1 

i 1,7)=0. 

w< 

[1,8) -0. 

Wl 

: i,9) =0c 

Wl 

[1,10)=0. 

[ 1,11)=0. 

'.,' 

1,12)=0. 

w 

ll,13)=0. 

I.' 

[ 1,14)=0. 

M 

;i,i5)=o. 

Wl 

:i,i6)=o. 

IV 

2,1)=11. 

w 

[  2 , 2 )  =  1 0 . 

105 


W(2,31 

W(2,4) 

W(2,5) 

W(2 

W<2 


W( 
W( 
W( 
W( 

W( 

w< 

W( 
W( 
W( 
W( 
W( 


2, 

2, 

2, 

2, 

2, 

2, 

2, 

2, 

2, 

3, 

3, 
W(3,3) 
W  (  3 , 4 ) 
W(3,5J 
W(3,6) 
W(3,7) 
W(3,8) 
W  (  3  i  9 ) 
W(3,  10 
W  (  3  , 1 1 


6) 
7) 
8) 
9) 
10 
11 
12 
13 
14 
15 
16 
1) 
2) 


W( 
W( 
W( 
W( 
W( 
W( 


3, 
:>» 
3, 


12 
13 
14 
15 
16 
1) 


3, 

4, 
W(4,2) 
W(4,3) 
W(4,4) 
W  (  4 1  5  ) 


W(4 

W(4 

W(4 

W(4 

W(4 

W(4 

W(4 

W(4 

W(4 

W(4 

W(5 

W(5 

W(5 

W(5 

W(5 

W(5 

W(5 

W  (  5 

W  (  5 

W(5» 

W  (  5 , 

W(5f 

W(5, 

W(5f 


,  /) 
,8) 

,9) 

,10 

,11 

1 12 
,13 

,14 
,15 
,16 

il) 
i2) 
,3) 
,4) 
,5) 
,6) 
,7) 

,8) 

o  \ 


10 
11 
12 
13 
14 
W  (  5 ,  1 5 
W  {  5 , 1 6 
W(6,l) 


W< 
W( 
W( 
W( 
W( 
W( 


6, 
t>» 
6, 
6, 
6, 
6, 


W(6, 
W  (  6 , 
W  (  6 , 


2) 

3} 
4) 
5) 
6) 
7) 
81 
9) 
10 


=  10. 
=  9. 
=  9. 
=  8. 
=  6. 
=  4. 
=  2. 
)=0. 
)=0. 
J=0. 
)  =  0. 
)=0. 
)=0. 
)=0. 
=  14. 
=  14. 
=  11. 
=  10. 
=  9. 
=  8. 
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DELK=D 

IF((  I  . 

DYD1=D 

DYD2=D 

DYNDl= 

DYND2= 

YY1=(Z 

YY2=-< 

YN1={ W 

YN2=-( 

RETURN 

YY1=0. 

YY2=0. 

YN1=0. 

YN2=0. 

RETURN 

YY1=Z( 

YY2=-Z 

YN1=W< 

YN2=-W 

RETURN 

END 


X-X(K) 
EQ.23) .OR. ( 
ELX*( 2(1*1, 
ELK*(Z(K* It 
DELX*( W<  1*1  ,  J)-W( 1 , Ji 
DELK*( W(K+1, J )-W(K,  J ) 
{  I,  J) *DYD1 )*l.E-05 
Z<K,  J)OYD2)*i.E-05 
( I, J J+DYND1 )*1 .E-05 
W(K,  J)«-DYND2)*l.E-05 


J.E0.16) )     GO    TO    2 

J)-Z(  I, J)  )+DELY*(Z(  l,Jfl)-Z(I,J)J 
J)-Z(K,J)I*DELY*<Z(K,J*1)-Z(K,J)) 
)+DELY*( W( I , J+l)-W( I, J) ) 
)+OELY*(W(K,  J+1)-W(K,  J)  ) 


I,  J)*l.E-05 
<K, J}*l.E-05 
Ii  J)*l.E-05 
(K, JJ-l.E-05 
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//ASTOF    JOB    ( 1025, 0732, EA32) , • AS TORQU I Z A* ,TIME=20 
//    EXEC    DSL, REGION. C=150K 
//DSL.FT06F001    DO    SP ACE= ( TR K , ( 5 , 1 ) ) 
//DSL. INPUT     DD    * 


COMPUTER    PROGRAM    IV 


CONTROLLED    PLANT    RESPONSE 


INTEG    TRAPZ 
INTGER    NPLOT 
CONST    NPL0T=2 


*  HYDRODYNAMIC    COEFFICIENTS 

PARAM  MXUD=-0 .0085, XU=-0. 0012 

PARAM  MYR=-0. 0051, YRD=-0. 0027 

PARAM  YV=-0. 01243, MYVD=-0. 015 

PARAM  NVD=-0.00019  7,NV=-0.003  51 

PARAM  NR=-0. 00227, IZNRD=-0. 00078 

PARAM  YDEL=0.0027,NDEL=-0.00126 

PARAM  XN=. 00005 
PARAM,  TOP=-. 3490401396 

*  INITIAL  CONDITIONS 

INCON  Y10=-.2,Y20=.2 

INCON  X10=l. ,X20=0 

INCON  U10=l. ,U20=1 .2 

PARAM  DN1=0. ,DN2=0 

PARAM  YY1=0. ,  YY2  =  0.,YN1  =  0. , YN2=0. 

*  DESIRED  FINAL  SEPARATION 
PARAM  DFIN=.24 

*  FEEDBACK  LOOP  GAINS 

PARAM  K2  =  2.9i  7,KT2  =  2.042 , Kl =2.9  75 ,KT1  =  2. 775 

PARAM  KY2=1.511,KTY2=2.878,KY1=3.003,KTY1=2«783 

INITIAL 

*  CALCULATION  OF  THE  COEFFICIENTS 


A11=-MYVD 

B11=-YV 

A21=-YRD 

B21=-MYR 

C11=0. 

C12=0. 

C21=0. 
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A12=-NV0 
B12=-NV 

A22=-I ZNRD 

B22=-NR 

C22=0. 

A33=-MXU0 

B33=-XU 

P=A33/B33 

KC1=XN 

KK1=KC1/B33 

KA=YDEL 

KB=NDEL 

D=A11*A22-A12*A21 


INITIAL  SEPARATION 


0Y0=Y20-Y10 
DXO=X20-X10 


CALL  S LOPES ( DXO , DYO , YY1 , YY2 , YN 1 , YN2 ) 
DERIVATIVE 
*      SIMULATION 


DX=X2-X1 

DY=Y2-Y1 

YD0TI  =  CD0TI*SIN(B1)4-AD0T1*C0S(  Bl  ) 

YDOT2=CDOT2*SIN(B2)+ADGT2*CGS(62) 

vnnTi  -rnnn  ^rnc  /  01   >_Ar\nTiy-CTM/oi   \ 

XDCT2=CDGT2*CGS< B2)-ADGT2*SIN(  32) 

ADD1=(A2  2*I11-A21*I21)/D 

ADD2=(  A22*I  12-A  21*1  22  }  /0 

BDDl  =  (  AU*I21-A12*I  1  1 ) /D 

BDD2=( A11*I22-A12*I 12)/U 

AOGT1=INTGRL(0. , ADD1) 

ADOT2=INTGRL(0. ,AD02) 

BD0T1=INTGRL(0. ,BDD1 ) 

B00T2= INTGRL(0. , BDD2) 

CD1=REALPL(0. , P, KK1*DN1 ) 

CDOT1=U10+C01 

CD2=REALPL(0. ,P , KK1*DN2) 

CD0T2=NORMA(DX,U20,CDOTl) 

A1=INTGRL(0.,A0GT1 ) 

A2=INTGRL(0.,AD0T2) 

B1=INTGRL(0.,BD0T1 ) 

B2=INTGRL(0. ,BD0T2) 

Y1=INTGRL(Y10,Y00T1) 

Y2=INTGRL(Y20, YD0T2) 

X1=INTGRL(X10,XD0TI) 

X2=IN7GRL(X20,XDGT2} 

I11=-B11*AD0T1-C11*A1-B21*BD0T1-C21*BH-IF1  1 

I12=-B11*AD0T2-C11*A2-B21*BD0T2-C21*B2+IF12 

I21=-B12*AD0T1-C12*A1-B22*BDCT1-C22*BI+IF21 

I22=-B12*ADOT2-C12*A2-B22*BDOT2-C22*B2+IF2  2 

AF11=REALPL(0. ,0. 1,KA*DD1) 

AF12=REALPL(0. ,0.1»KA*DD2) 

AF2l=REALPL(0. ,0.1fKB*DDl ) 

AF22=REALPL(0. , 0 . 1 t KB*DD2) 

IF11=AF11+YY1 

IF12=AF12+YY2 

IF21=AF21+YN1 

IF22=AF22+YN2 

B1G=57.3*B1 

B2G=57.3*B? 

DYD0T=YD0T2-YD0T1 
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*  DDC=COURSE  CONTROL  ACTION 

*  DDD=DISTANCE  CONTROL  ACTION 

DDC1=K1*B1+KT1*BD0T1 

DDD1=KY1*Y1+KTY1*YD0T1 
DDC2=K2*B2+KT2*BDOT2 
DDD2=KY2*(DY-DFIN)+KTY2*DYDOT 
D01=DIOO(OD01,DDCl,TOPJ 

DD2=CARLO(DDC2,DDD2,TOP) 

DD2G=DD2*57.3 

DD1G=DD1*57.3 

DYNAMIC 

*  ACTUAL  SEPARATION 

DX=X2-X1 
DY=Y2-Y1 

CALL  SLOPES(DX,DY,YYlTYY2, YN1,YN2) 
SAMPLE 

CONTRL  FINTIM  =  2<t.,DELT  =  .013,DELS=.013 
PRE  PAR  .013fBlG,B2GfYlfY2»DDlGfDD2G 
PRINT  • 13iDX,DYfYYlf YY2,YN1 , YN2 , 3 1G , B2G , X 1 , X2 

IF(ABS(DY).LE..05)WRITE(6,3) 
3    FORMAT  ('_%'  LATERAL  SEPARATION  LESS  THAN  25  FT1) 

CALL  D  R  WG ( 1 1 1 »  T I M  E » Y 1 J 

CALL  URWGi 1 ,2iTIME*Y2J 

CALL  ORWG(2,lf TIME, BIG) 

CALL  DRWG(2,2,TIME,B2GJ 

CALL  DRWG(3,1,TIME,DD1G) 

CALL  DRWG(3i2,TIME,DD2G) 
TERMINAL 

CALL  ENDRW  (NPLOT) 
END 

PAR AM  KY2=1. 533 , KTY2=2 . 608 , KY1=3. 32 t KTY1=2. 555 
PAR AM  K2=2.853»KT2=2.141,Kl=3.069fKTl=3.08 
INCON  Y10=-. 18,Y20=. 18 
PAR  AM  DFIN=.3 
END 
STOP 

FORTRAN 

FUNCTION  NORMA(DX,U20TCDOT1 ) 

CD0T2=U20 

IF( ABS( DXJ .LE..00  5)    CD0T2=CD0T1 

N0RMA=CD0T2 

RETURN 

END 

FUNCTION    DID0(DDC1,DDD1,T0P) 

DD1=DDCI+DDD1 

IF(DOl.LT.TOP)     DDl^TOP 

DID0=DD1 

RETURN 

END 
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FUNCTION  CARLO(DDC2,ODD2,TOP) 

DD2=DDC2+DDD2 

IF(OD2.LT.TOP)  DD2=TOP 

CARLO=DD2 

RETURN 

END 

//C.SYSPRINT  DD  SP ACE= ( TRKT ( 2 , 2 ) ) 

//PLOT. STEPLIB   DD   QSN  =  SYS3 .DSL  PLOT , UNI T  =  232 1 , VOL=SER  =  CEL0O 

//PLOT.SYSIN  DD  * 
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//ASTOF  JOB  ( 1025,0732, EA32 ) , ' A STORQUI Z A* , TI ME=20 
//  EXEC  DSL, REGION. C=150K 
//DSL.FT06F001  DD  SPACE= ( TRK  ,  ( 5 , 1 ) ) 
//DSL. INPUT  DD  * 


COMPUTER  PROGRAM  V 


CCNTROLLED  PLANT  RESPONSE 


INTEG  TRAPZ 
INTGER  NPLOT 
CONST  NPL0T=4 


HYDRODYNAMIC  COEFFICIENTS 


PARAM  MXUD=-0. 0085, XU=-0. 0012 
PARAM  MYR=-0. 0051, YRD=-0. 0027 
PARAM  YV=-0. 01243, MYVD=-0. 015 
PARAM  NVD=-0. 000197, NV=-0. 00351 
PARAM  NR=-0. 00227, I ZNRD=-0. 00078 
PARAM  YDEL=0*0027,NDEL=-0. 00126 
PARAM  XN=. 00005 
PARAM  TOP^-. 3490401396 


*  INITIAL  CONDITIONS 

INCON    Y10=-.18,Y20=.18 

INCON    X10=1.,X20=0 

INCON    U10=l. ,U20=1.2 

PARAM    0N1=0.,DN2=0 

PARAM    YY1=0. , YY2=0. ,YN1=0. ,YN2=0. 

*  DESIRED    FINAL    SEPARATION 
PARAM    DFIN=.3 

*  QUASI-OPTIMAL    FEEDBACK    LOOP    GAINS 

PARAM    KY2=1. 53  3 , KTY2=2 .608 , KYI =3 . 32 , KTY1=2. 5  5 5 
PARAM    K2=2-853,KT2=3.2115,K1=3.06  9,KT1=4.62 

INITIAL 

*  CALCULATION  OF  THE  COEFFICIENTS 


A11=-MYVD 

B11=-YV 

A21=-YRD 

B2l=-MYR 

C11=0. 

C12=0. 

C21=0. 
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A12=-NVD 

B12=-NV 

A22=-I ZNRO 

B22=-NR 

C22=0. 

A33=-MXUO 

B33=-XU 

P=A33/B33 

KC1=XN 

KK1=KC1/B33 

KA=YDEL 

KB=NDEL 

D=A11*A22-A12*A21 


INITIAL  SEPARATION 


DYO=Y20-Y10 
DXO=X2O-X10 


CALL  SL0PES(DX0,DY0,YY1,YY2,YN1»YN2) 
DERIVATIVE 
*      SIMULATION 


DX=X2-X1 

DY=Y2-Y1 

YDOTl=CDOTl*SIN( Bl )*ADOTl*COS< B1J 

YDOT2=CDOT2*SIN(B2)+ADGT2*COS(B2) 

XDOT1=CDOT1*COS { SI )-ADGTl*SIN! BI ) 

XD0T2=C00T2*C0S ( B2)-ADOT2*SIN< 62) 

ADD1=( A22*I11-A21*I21)/D 

ADD2=( A2  2*I 12-A21*I22)/D 

BDD1  =  (  All*I21-A12*Ul)/D 

BDD2=( All*122-A12*l 12; /D 

ADOTl=INTGRL(0.f ADD1 J 

AOOT2=INTGRL(0. , ADD2) 

BDOTl= INTGRLCO. , BOOl J 

BDOT2=INTGRL(0. f BDD2 ) 

CD1=REALPL( 0.,P,KK1*DN1) 

CDOT1=U10+CD1 

CD2=REALPL(0. , P,KK1*DN2) 

CDOT2=N0RMA(DX,U20,CDOTl) 

Al=INTGRL(0.,ADOTl ) 

A2=INTGRL(0.,ADOT2) 

Bl=INTGRL(0.fBDOTlJ 

B2=lNTGRLIO. , BOOT2) 

Y1=INTGRL(Y10,YDOT1) 

Y2=INTGRL(Y20,YDOT2) 

Xl=INTGRL(X10,XOOTl) 

X2=INTGRL(X20tXDOT2) 

I11=-B11*ADOT1-C11*A1-B21*BDOT1-C21*81+IF11 

I12=-B11*ADOT2-C11*A2-B21*BDOT2-C21*o2+IF12 

I21=-B12*ADOTl-C12*Al-B2  2*BDOTl-C22*3H-IF21 

I2  2=-B12*ADOT2-C12*A2-82  2*BDOT2-C22*B2*-IF2  2 

AF11=REALPL(0. ,0. 1,KA*0D1) 

AF12=REALPL(0. ,0.1,KA*DD2) 

AF21=REALPL(0.|0.1,KB*001) 

AF22=REALPL(0. ,0.1,KB*DD2) 

IF11  =  AF1  H-YY1 

IF12=AF12+YY2 

IF21=AF2i+YNl 

IF22=AF22+YN2 

B1G=57.3*B1 

B2G=57.3*B2 

DYDOT=YDOT2-YDOT1 
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*  DDC=COURSE  CONTROL  ACTION 

*  ODO=DISTANCE  CONTROL  ACTION 

DDC1=K1*BH-KT1*BD0T1 

DDD1=KY1*YH-KTY1*YD0T1 

DDC2=K2*B2+KT2*BDOT2 

DDD2=KY2*(UY-DFIN)+KTY2*DYDOT 

DDl=DIOO(DDDl,DDCltTOP) 

DD2=CARLO(DOC2,DOD2tTOP) 

DD2G=DD2*57.3 

DD1G=0D1*57.3 

DYNAMIC 

*  ACTUAL  SEPARATION 

DX=X2-X1 
DY=Y2-Y1 

CALL  SL0PES(DX,DY,YY1,YY2,YN1,YN2) 
SAMPLE 

CONTRL  FINTIM=24.,DELT=.0i3tDELS=.013 
PRE  PAR  .013  tBlG,B2G,Yl7Y2,001G,D02G 
PRINT  .13,DXfDY,YYl,YY2tYNl,YN2tBlG,B2GfXl,X2 
IF(ABS(DY).LE..05)WRITE(6,3) 
3    FORMAT* s  ^'LATERAL  SEPARATION  LESS  THAN  25  FT») 

O  M  l_  L.   U  r\  > «  o  t  i.  »  i.  j    i  i.  i '  i  i_  y  i  1  } 

CALL  DRWGi 1 » 2» TI ME » Y2) 

CALL  DRWG(2,1»TIME,B1G) 

CALL    DRWG(2f2fTIME,B2G) 
TERMINAL 

CALL  ENDRW  (NPLOT) 
END 

PAR AM  K2=2.85  3,KT2=2.141,K1=3.069,KT1=4.62 
PAR AM  KY2=1.533fKTY2=2.608fKYl=3.32,KTYl=3.83  25 
END 

PAR AM  K2=2.85  3fKT2=2.141tKl=3.069,KTl=4.62 
PAR AM  KY2=1.9  1625f KTY2=2.60  8,KY1=3.32,KTY1=3.8  325 
END 

PAR  AM  K2=2.85  3,KT2=2.141,K1=3.52  935,KT1=4.62 
PAR AM  KY2=1.9  1625f KTY2=2.60  8,KY1=3.3  2,KTY1=3.8325 
END 
STOP 

FORTRAN 

FUNCTION  NORMA* DX,U20,CD0T1 J 

CDOT2=U20 

IF( ABS(DX)  .LE. .005)  CD0T2  =  C00T1 

NORMA=CDOT2 

RETURN 
END 


1>8 


FUNCTION  DIDO(DDClfDDDl,TOP) 

DC1=DDC1+DDD1 

IF(DDl.LT.TOP)  DDl=TOP 

DIDO=DDl 

RETURN 

END 

FUNCTION  CARLC(DDC2,DDD2,TOP) 

DD2=DDC2+DDD2 

IF(DD2.LT.TOPJ  DD2=TOP 

CARLO=DD2 

RETURN 

END 

//C.SYSPRINT  DD  SPACE= { TRK, ( 2 , 2 ) ) 

//PLOT.STEPLIB   DD   DSN  =  SYS3 . DSLPLOT, UN  I T  =  232 1 , VOL=SER  =  CELOO 

//PLOT.SYSIN  DD  * 
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